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(2) 1^^2 00 1 -1 5 03 70 



n/c±f*<tTt8fiE*n. TK©jli!!)lcJ:Ui»ffi)gffi^||gi 

Kffl L/ci^Sft^^^ijs/i-r «|£1iiJ!|ajilfr#l8t. 
l51iJB$(D3S»«i|ajS-r«#©<!:. 

I£«iji5»fcj5 cfcs*±)8« y miff / - y^m^r^^ 

TK<DSi6tCj;yiKil)g?t«:P^s^I6P#'y hT'» 
*E«J L/j:*'*5*^«*"JBr-r *iefi!|JpJBr#fi8tx 

3e^±6^yi!)fp/^••S'->^sl^T■r ^afiif 

[ffl^R^ 5 ] BulBi*l^gPii'>^ < <!: t a -fili:^fp|<DpiiJ) 
a-i4:^rRiORii)jg*)S**'jffl-rsc<t:&it?s<!:-rssi 

ifS^jge] BuiBt*:|^gPi*'J^^<<»:tP-^Hft:)?fn]0pr 
gi5p-/i/}iii:«i i^o^ae ait^&f ijffl-r « c: t f 

SW^RJlSlciBWroPjCif^ibP'lt'y ho 

TIK<3!)311l!i(c«J:yi^l!)g!S^KlSCi»I6P hTS> 

a^'y ho 

ho 



gds^^WLs •fftcD^fiiJsS^icigfT-rsrctocDMiBaf^ 

Ci:«1fai:r«fi3KiS7lcf3K©lffli^l!lP'1«y ho 
lm:!m^ O] B5f3tt:??gP»'>S<<!:tP-^U«6^fSi(D 

ibf^/ x'^j - V wsi*??gpp-;uia:^iSijcDpii!iS e&s^w 

fflf -SC t«<tSt<fr«^^«7 lcf3«l©PiC»i!lP?}? 

•y ho 

*+i/j:±f*<tT-«lfi8*tU TKcDili!llcJ:y»Sjea* 

h(0B)fpsijia)7?jSo 

tl. TIR<Dilffi)(cJ:y:g«g?E^K)^iSiiP<)t-y hCD/c 

T^-yzft. ^mmr^iit^mwitr^m^wja4'.'y 
h(DmfFmwyD}io 

TrnTtt:|fBPfcm3£<OprBlSS)S«Jto±<*<t:T'«i^i8* 
n. TK<Oji»)lc<fcyi^iftgaftl|iP^i»i!iP<K'y KD/i: 

efflB$lC'J>^ < HU8B#:|*gP(7)pJt!jgSS(7)SG*^P 
^il<!:^?fM<!:-r^PjC:Ki!)P<Jt-y htOftf^SW:^ 

a. 

[||?R«14] BuIBi*l^aJ«'>^<<!:ttf-y^$ili;^r^(D 
pri!lSB6)g^«U BulBSa^±«<*Ji!lf^A°^->l*Kf* 

^^\d-y^M-:^i^<op!W)mAm^mmr?>ct^imt 
r^nmm^ 3ictBm(Dm^^Wia7s^>y h<D9bnf&m:^ 
mo 

immm 1 5 1 ButB<*$?gpi*'>^ < 1 1. a -tiii:&ipjco pi 

IfteSjt^^L. B5iBS?^±6^yi()f^/\''S'->«iS<*l^ 
gpa pTift g S^^f Uffl-r ^ c ^Itmi: -r S 

!i3?^i 3ic%Bm<Dmimmu7^y h(Dmf^mwy5mo 
immm 1 6 ) Mi3<*»a5«'>^ < i t, p -/hiii;?ir)<o 

^r^n^m^ 3imn(Dmi(.^Wia^'y h(DWii^fsim^ 

;£o 

lm^m^ 71 '>^<ttTK<!:, KTKO±^(ci3ia 



(3) 



2001-150370 



[K^JSI 9] BuiS<*l*gPli'>^<i:t.3-||li:&lRjCDRr 

< <!: t,<*l$gI5tf ^ISlORlftg B6)S*f ijffl LTSane 
Bi!B|JSt;BPffl^-tl-Ftl©SJ*glS»l^±*i<3t*^ JtJa Ltz^ 

|S]lt3g^lcR6orc<t:*<0/c«S6<^i(lf^SiJ^ai:^;£T»r?T. 

^^a^-y y-<om>b'^mi5izi»Wi-^^^X5^'yyt. 
•y h CO Z M P ti^S.Slim0^mmcK-otc C t (CtS^* LT^ 



'i^^ < i: t f*$?SP3 -fft <D Rlll!l e Uffl L T -5 of* 

nv Tf&(Dmmcji*mwiBt^i3imi(^wsa7f.'yhtm 

# nT{*^g|JlCRlTS<0 plid g B6)S^Jto±(* <!: T-^ifiE* 
tiv TK<Djl»tcj:y|J»)ea'5:W^i»»)P':Jt'-y hJbMflJ 

n. TK<DSiiileJ:y^i!lSS^ffii^ftP<Jt-y hft^e 

( a ) ffl]|filltiS^/)^6«ie§S^lC^e-r5X7^ -y 

(b) m^mf^<or>^it'm^\zWi'7-r^7.'r'yy. 

(c) ^o«-B-3S»6^efiH£§g|?lCi»?7-r«X7^-yy. 

(d) mm^mf^^w\ps\>m^[zwi7t^7.7'-y:f. o 

[0 0 0 11 

^Sif^^^ 7^;HkLT«fi84-n« y Xt^-t >y ^'J&p 

[0 0 0 2] MlCf¥L<«x *SgB^«. *^7i))ff?5:^^7> 

* C <t Ai«T'5 ^MiCi^iJiSP ':Jf -y h (D^my^ t)-Xh.\z 

ic J; y If »r L/cf^il« gibWlCBBa-r S C tfe^T'SSP 
[000 3] 



(4) 



1fBB2 001-150370 



hj ti^oo a^^-y commit. X5:?1i©ROBOT 
it. hfc'igSLSfeto/cCDl* 1 9 6 0*f«5S*^6T' 

%<lf(7)MllfflP<K'> h (industrial rob 

o t) T-^-p/co 

[0 0 04] gjfiTliv t l-^+>-;U^<!:W2SillE*iT 

mmvi^ s i: •? ^T-mtiTi^^o 

[0 0 0 5] t i-<DSfls:^:^7-XA-^P>lJ)f^^X~ iU- 

eL<tt rxSISlj a)P#-y h (humano I d r 

obo t) ^:Pf,5^o Ar^^P#y hliv cy?i(#^ ^iSS 

[0 0 0 6] ArsmmL<iiAmmiimt*i^a^y b 

fflg-rsci.tjb'ST'^cfc-Pc 
[0 0 0 71 1-P«. AF^3pti^W^?SjiSTfi«o r^to 
■5. AF^roT)KSt>'/Xl*±)K(::(Wfc*lljgcDP*'>y 

au-h-rstt^-prp-bx^jii^T. ^n^i^ibtr 

SAF^(Dg«^i!)f^CDp< * - XiA^Ii^WlC^^f S C 

sift^ * 3xz»*a 3 f6<o* s s ft wss^soJistc 

[0 0 0 8] t,5 10tt. AF^<7)/\°- hi^-iLTfell 

ftli®lcfcn:^;5A6«lSi<ja)3^S^?T-5 P#-y h-C0FJ5lT- 
fe«o c:oa<DP/:Jt-y AF^®^a3^«£D* 

ii-r«AHx»^^'\<Dm^»«^aL. 

6l!:i«SLTlK«J^^*'«SSo cot*. P<J?-> 

TAF^Ff^j rts.^-^Amtmi^m^itmcmm^LTi^ 

[0 0 0 9] «iJ^tSf. ®A/T«'5:6ftt^®»%l^ei+'5: 
)b^6SPM^5a^Jt6^t«:^»«S|ift^cfct^TP'1?•y l-lc» 
5T-r5<i:3^Ji^x <7P-^^-¥>4je5CP'1^-> hcDJC'P 



lDl;<^:3ft^g5f^LTL^•5 2s#^7P'■J^•y hcD^^'in- 

P<l?-y KDP V hP-/Uj (gil!l»a*l5^fMM3ta<S 
Si>No. 25, 1 996APRIL) 

t) o 

[0 0 101 AH<DfP3ISH-¥>M<SSSO«i:A/^«s 

•rs, L*^Lft<)^6^ i^M->X7^A-r 35:^p-6P':K'y h*^ 
»'«^ ftAWfPHSmT ? 6 iCArS(Dit^rSic-^ < s 
SLTt^</ca6lcW. p?K-y l-Oi^«jDrffi$5H*'«AFa© 

IS P 'y h <7)llffi< b<)'':^lMclBi#5-nT -Sp/rJ-y S 
i.o AF^§2a)m»^*LTt^Siri:l*> P^-y hAW^ 

[0011] AF^SP'^n-y 1 LT^ 

Sift • *«S»^lc*jCt*S«collfpm©f^tT6'«Plf 6. 

[0 0 12] fiu c(Dmo:>mmmmicnitLrcn7fs'y 
h li, ^m<om^m l < ti^^gg^m^-r set a^isw- • 

«f^±©M±<0±STi6y. 2S#tT=£BU^<!:»-rS*. 
-XZ^-^i!i#^;^ttilS<t: LTJ£5llcS3ESf Sjt^gtiJt^ 

gr'^^T^So c<D!iess 2s*?Ttii^^t.. p?j? 

[0 0 1 31 S/c. AHSP<J?>y h(DflfiOfflaS<i:LT, 

-rts^-^Amt(D r«^j <t:t^-5ffli^6^Ptfen 

So croao5P<K-y t: l-¥'-9-;Uftt'W2SCDillz: 

46^T'«SC<l:6'<a$Ll\ *6lc. 5^«)A^?tV/i:i!) 
f^/ \°^« - V^mic j£5*t<:*?T-r S /-ctt Tttft < . m^o 
S^-^-HSJt ( r^«>Sj <!:6^ rpfciSj . rpp<j ^if) 



(5) 



1tB82 0 0 1 -1 5 0370 



[0 0 14] I!ft!:^«©<fe7(c. AW*aS<DBIII!5-rft 

[0 0 15] CCOtctf). AWJ:.V'i^lt^i3HC'p1l^.l^m+ 

[0 0 16] «ij7inr. 3 ic§ii»:it«j«o«i 

mT&^^tf,t. AF^i^*£©tg,«6^eeticwe.*^T- 

ro^5Sffi«i^OAF^SP*-y hlc«S^T-^;i,„ ^fcM 
[0 0 1 71 ^fc. 2Sil3i#?T^tT5PiCf$i!)P'1^-y 
CD*l!a6'f>%< ^«<!:<i:t,lCs fi'i:>ffiB6'<;g< Jfe^/c 

[0 0 18] 2^m'i^rLj^^m^m^'i^o^^y<Du 
h ics-r S3e»«lJ^iBl^fi^*^T^cB^•r sfirfffttKic 

[0 0 19] p<jf'> p#'-y v<Dm 



[0 0 2 0] #tTBtlc«. fi^<»:#fTili*tC<¥*oTt 

^RU^P-;Hftt-p<>h6^-t!"P<!:^«,-^.. f^^^-^ 
rz MP (Zero Moment Point) j*f 

[0 0 2 1 1 p^i^iiip.f; -y hwg^essnai-^^tT^ 
cDefiij|5S±icgii-r%jisg<D^<«x iiwzMP«#tT<D 

[0 0 2 2] 0U?lt#x !|tBg¥5-305579^4ifglC 

tiv p^^»iP'it>y ^^D^^f$'J^alil@^cot^TFf35^LT 
i^s, wjm\.z%2m<Jimzi&mmm.\t. zmp (zer 

oMome nt P o i n t ) ■r**5"B^?Tt"«<!:*<0 

[0 0 2 31 *fc. 1tMiF5-30 558 1 ^iiffllClB 

tt<OKiiC^iftp#-y hli. ZMPft'i^J^^Si* (^^ 
»J) rta5> XWx IS0I?B$IC Z M P 3t)<3^J$^Efls; 

tR^Sffiigf /cH+ ZMP (D^*§««fe y . *tT<oe:£lto3iR) 

[0 0 2 41 $/c. 1«F»g¥5-3 0 5 5 8 3^4i»lC 

»s m^^mut^-y h(7)#* JIJS^ ZMP B^^fiBtc J: 

^»-> • 7='-^'«m\ zMP^giisfflBic— as-ti-s 

J: a iclWigpMgis^lESj-r otitic. ±f*<DlS!t4*)K!is 

SfcZ M P««a<iffiB(!:itiJffliT* «<^T\ j^BPS^jfffil!: 

[0 0 2 51 ^fcs f#F»fW5-3 0 5 5 8 5#4i$BlC 
PiC^i&P ?K<y h <D«itii4BS ZMP a^^lilBlc J; 

aiicfBtgcopiC^KPTt^'y hi*. ZMP mm\tL^t.m^m 
■f5'&tc\,twj5^mm-t^t\ xf*. zMpa«ffiB«t> 



(6) 



1^682 00 1 -1 5 03 70 



[0 0 2 6] ^/cx ^tBa¥5-3 0 5 58 6^ii$aiC 

miciim<om^^W}a <k h (i. z m p smiSLS^t> v 

[0 0 2 7] #^7P'1^-y l>cD$£§J<!:l^3««S^*^lci2l 

^i'SS. <i:yt3ttB3)©*a!t)^'>35:t^2S*?TP*'y 
JS^x W5SS!liS6^6J:3-^<llffl<bO«1#«»*'ttS-?- 

[0 0 2 8] L/-c6'«oT. «iiJ«*^8tcR§<'«^%SIC 

[0 0 2 9] P<Jt<y h*^«>S7^»S!fe-¥'^;1'J(Z)««*S 
*'«S»jfp/<-J'->*fiijt«Ct*'«liJPiCi^iilP<}ty 

[0 0 3 01 m^^mmw■^ i -4 a i 7 o#ii$sic 
oT. p*t'y h'¥>p<K'y ht^mmT^m^mi<ovBi^(Dm 

[003 1] « /c. UtXiza^^y h*.^ r|5®J-r^j <!: 
[0 0 3 2] #y;^l#ia3 5(OT^-rj:-5^MiC»ftP<tt-y 

^-^c•:pt^T%^LT^§o mmiCTjiraTt^'y bit. 2s 



»5„ ML. l21,xs(cg^-rP'1?'y h<0«#v »$*gP(Cgd& 

[0 0 3 3] -)3gic. m^^ma7jr.'y h^c^5^^5#^f 

2Jg#iT©P*<y KDli^T-fentfs iEfeO)l!SI*52StC 

•r«M)^i»i!iP'1?-y KOJl^. Ml<oe*JtO*^^c<^:■:3 

[0 0 3 41 E3 61CI*. 1213 Stt/XxL/cPse^i&Pm- 
pa)tt"i:Ngp±tc^ y X z m p ttpssisgptossf p^<d^ 
[0 0 3 5] S/cs E3 7ic(i. e:cDMie^BiP#>y h 

[0 0 3 6] mz^j^m'^Lrci^mit^mnTi'^y h 

[0 0 3 7] ctiicjtju ■t*^BP(c■p^,^T^*^ #^T•^fF 
*nTt^^KiiC^KP*'y l-a)l5i:A/<!:l*> 1213 51C5^ 

[0 0 3 81 ccT. ms 5iZ7rrj:oiSiimmzmA 

[0 0 3 91 m«E3 8lC^-r<fc335:3o«-t*i5^*> 



(7) 



1^89200 1-1 503 7 0 



ctic^v. ^oa['C^^^t•6±^fTL^< (039 

[0 0 4 0] «/c, fi/i>^Jf6±lf*<Dtl^B$lCjeBP« 

m'\>t'^m.^mmmm<D±&c^m lt. z m p ti^mmm 

-rctft^sjggi:^;!, (114 1 £:<!:) , ?6lc. 

[0 04 1] L*^L^*'i6, *I^ICW, =SMii5(DRjaft 

4 o*-6Ei4 1 ^mm^m^iit^m. m^mmi^^rc 
z M p (o^m^msi'^, ZMP fi^es^^tcggAf « 

[0042] $ /c^ 043 ICS^r J: -5 (CSJIJCiKIftP ?J?-y 
l-6MIPlRltt5S^T-$£fliJLTL«orcJi^. a;J?>y hfe'^S 

[0 0 4 3] fflrS|lt^^6^6S^±*>«yKjfP^t7-5«l 

[0 0 4 4] s.^tmmt<o^n6f3s^mt'^yt^'hi<ts 

Z M P A^Sgp-r ^*3-53g^SS^^^F«3{C Ao Tl^^ 
*#Jg*i±* c: i: J: oT«'i>«-* 6 it Jt^±if * c t 

[0 0 4 5] L6^L*#«e. SllSJtctt. vr>i)tit'ikmf^ 

<i:^^«T*^l^^Ii:««^l^„ fiijiltf. ±150)1214 5 !t)^ 6 H 
4 6'S3^«»?T*-t*-S|iR. IBi!*ffitfi?-a:/c$$-r«. 
IK^Jti^tcSJ/'iatrClirA^T-S-r^ Z M P :&Sg|5(D©^ 

m^U9f-^ <ts Z M P ««S£fiJgElcgl AT « b31::B8SP«! 

[0 0 4 6] E3 8~ia4 2T'5^Lfc-5-:>tt1t3S^jb^6 
<De?^±««yi!)#. St>\ 04 3~E4 7 WxLfcWlR) 



04OSt>'E14 1. Mmc, EI4 6S0-E14 71C/XX 

[0 0 4 7] $fc. ±a>Lfc:dO«-ti:SU-ffll(p]t:M^-rn 

f*<DS»i>ttH*SgP#ifilCiS)g-rih.»f. E4 1 •¥>04 7 
MP:&3g^S^«JSIlCi»l!)5--a:;5iI<!:««T-$^o 'S'Vl/T 
[0 0 4 8] PTtt-y hC0«/i>6^^lJ:#t7*©SlSro«iti 

[0 0 4 91 cnicswu oTt^y b(Dm'i>ti^mm<Dmc 
i^l-ti5d;-5^ ^lJ!I^^fJ :&^T^'S"ry(DP?l^•> KDJi 

[0 0 5 01 I2I3 8~EI4 2. MtflC, E4 3~04 7 

[005 1] fte?^. P*';/ KOttt?SP«lS4a5lcSS<fl|^ 

CtlcjzoTs IKSPtMigPi:<7)*B3*WteS©Rl^a^a; 

SS-rSCltA^T-*^, JICO.^m. 1114 1^04 7icm-r 
<fe Z M P )b'i3g^S^^^tCASBylcffi5gP6''m LT 

[0 0 5 2] L*^L>5:««6s ■f*l^gp^^< Lfc^. Mg|5 
<7)l£lS«$^-5CtlC^U. TASmj SL<» TAH 
[0 0 5 31 2|s:aiPB#U:*>nt*Wlse»i«)P/}t'-y h 



(8) 



?tra200 1-1 5 0370 



[00 54] 

[0 0 5 51 *«^oM^c«ge<j«> mmf^isiif^m 

(Om'Pi^^m LT L $ ^ /cJi^T^ o T t ^t)Tm^± 
[0 0 5 6] *5g^OMJ5:SeM«^ ^JLTLSl^« 

>!7 sis^s L < im&T-mrzt) -p t i^-s Jt^T-s -p t t 

[0 0 5 7] *fgR^©M3S:Se«J»> -p-P^-t*. ffllRj 
[0 0 5 8] 

[0 0 5 91 Sfc. *f8R«tDll2(DfflWtt. '>^<tt> 

^^©<t. ^^ii-rscit^i^at-rspaii^i&P'i?^ 

[0 0 6 01 $rc. 2|s:5gW<Dm3(D#M«. 'i^^< 

[006 1] *5|Bfl(Dm3a)iBiMlC^^Kl5e3^SjP<K y 
aSdbJt^WL#tJ:t^o droits. ffJSBiS*±*'<yi!i 



[0 0 6 2] ^^L>«. BijlB«i:|$gI5«'J^^<<bt.3-ffi 
[0 0 6 3] Mia<tl*a5W'J^^<<i:tP-;l/ 

¥±«« y Kf^/ - vt*K{*f?gi5p -/uMi^isifljpra a 

[0 0 64] $/cx 2|s:5gR^<^m4<Dffl'JS«. '>^<<!:t 
<t. iEeJl^#^!:«^<7)iS®JleS9^c«^T■r«fc^6©il!If^/<^^- 

[0 0 6 5] *fg^<Dm4a)fflijsic^*ffiiief^ap?}t')/ 
^T■r « /c«>(OBuiBBff / - >t*iSi*i?SP If f^idi:)? iR] 

[0 0 6 6] »5tM*. BulBf!ma5W'>^<i:t3-$ft 
[0 0 6 7] B5§Bi*l?gl5«'>%<<!:tP-;U 
[0068] $ fc. *5§^<DS 5 ©fflij® I*. < t 

tS^^mfiXf^Xx-yT^t. '>%<<!:t<*l^g|Jtr-y5^$ft 
® plib a fflS^f ijffl L TPa:iKi!i P # •> h ©M'i>^±:J? 
icjf •6±if SXT^'y '>^<tt,f*$?SiJe'y^$iS<D 

PiCi^ift P /I? -y h (D Z M P ««EfflJSBl5tSlSElc A o fc C t 

■r^cii^itmt-rspjC^Bip^-y h©»fp!6'J8a):^« 

[0 0 6 9] $/c. *5l^<Dm6(7)ffliffi». '>^<<!:'fc 



(9) 



1tra2 00 1 -1 5 0 3 7 0 



"r^v-fii. S5fB»i><)'<5t»BiJ:3&»C!^aL/j:^a> MiBliSi 
iti^i) □ h © Z M P ft^Jggpa^R^JsElc A o C <!: ic 

[0 0 7 01 ^/cx *l|0^<Dm7(D#JElix '>^<<i:t 
[007 1] ^fc. *5IB^©m8©ffliJ®ti. 

[0 0 7 2] S/c, *^0^©ll9(D«iMJ*x '>^<<!:'t. 

gffi^iffliie^a p '1? -y h is^n^Kr'&mm-o tzt%a>tc 
waie&is^ipjffi LT«i«3S»tci^fT-r«x7^y 

«i-r^i::i:^?$«<!:-r«IW5eiK!(iP/Ky K0il!if^l6iJffli^ 

[0 0 7 3] $rc. *f«^<^mi 0(DffiiM«. 
4>TKi:. KT)R©±^lciBtft*tiTi**ffiPfj:SfS(DRr 

iA S ffi^Paii^ift P # -y h *»«KfiJiSKlcP(i ^ Tct^cDfc 
it>a>W}if^m:^mT3l>-oT. (a) ffi][fi)lt§5»6^6«IE 
3e^^ciK^7■r«X7^•y:?^. (b) miniS^*^ 6^ 
3g©lcig?T-r^X7"-y:/. (c) ^-Ptt-ti-g^A^e^ie 
3S»^c^^7•r*Xx•y3^. (d) «l«3S^6>6ffll«3tt56 

[0 0 741 

[ffffil 2|s:5ig0^lc^«PiC^i()P/-)t-y h«x tmgpicfc 



[0 0 7 51 *S^lC#5P5Ci^BjP<Jt-y htCj:nt#s 
tlcdcy. •t*#g|JJ.X^<DpI!K)gi5'\<omfi-^g^Rh/l/<7/)^ 

[0 0 7 61 $/c> *fgB^lC^«P5Ci^SiP/1t-y htCj; 
[0 0 7 71 S/cx *5l^(C«S||gijCigliP*;>y htCj: 

titf. «»a)S£ffl3es&^Mi*«iyisr Cilery, ss* 

±*(«* C i ^ < &*)^^i!)^ll3Ei-r 5 d <»: 
[0 0 7 8] S/c. :^mmm^m^^W}n^-'y bizj: 

[0 0 7 9] mx\,f. P'1?-y hAi^«6<)^L;i6S$±*i<y 
fiBtJ&So «fc> iftff/<^->iaoDM'i^lcJ:y. /\-K 
[0 0 8 01 $/cs n/}?-y hjB'ttjRtcrsuftilif^/x*^- 

/ - >i»«<ii'j^-r * c t ic j: y . p /It- •> h g 

[0 0 8 1 1 S/c. *fl^lC#SP^^iftP/-lt"y hic«i: 

titf. IEffJiS»«S4b*H*«iit-^*±fi«yiftfP/<^» 
[0 0 8 21 ^tz. nm^m^miti-^^TLtx^i^i. 

©lis*, /^y7^yiffiE)BflS*^]lBU 1|sl<D?EIBT'J:y 

SB5F^(Dia!gg51l£6'! pItE 35: y . P -y h (DY^mmfS. 
Wm^m. f^MF«gSir6^ffi:^-rs, te^S^/\''yx 

t%yv istta)gffis*i''rs)±-rs, $/cx /^-yT^yrog 



(10) 



1tBB200 1-1 50370 



[0 0 8 31 *si^©*eicfa©aWs i^gi-^jiJi^ii*. 

[0084] 

[0085] 01 suia 2 ic«*siR^a>siS6ic#tT*-n* 

<D±K<!:. mSat. *iJ?BigPtT«i^trti«, 
[0 0 8 6] &^§>!7<DTK«. :*:Sig5i:. KBIS5t> 

[0 0 8 7] pmmt. COm^f^Wiat^'y h 1 O O^ 

$|Jffll^5^wt^3^c ^ j: -5 ^*s5j t ^ ^ Tt^«««. 
[0 0 8 81 :^mmmKm^m^wia7ifi'y n 0 0© 

T-S>^o m^^WjOTf^'y h 1 0 0««AP^<!:*#-r^±T- 
[0 0 8 91 E3SO^ia4(e». waii^fiin/l^-y h 1 0 

[0 0 9 0] mmic7jkr<k'^ic. i^^^mmt. ims^ 

3'3(DHfiseB&Jg*«i^TL^'5o fflj^«> •ftl*gI5P-/U 
^ii^ffiib-rsciticj:^, PSC»ijiP/1?-y H 0 0© 

[0 0 9 1 1 «fc, @ 5 zom^^muTj^-y k 1 



0 0 tmmr^mwssmmmi^z^mitmcTr. lti>«, 

[0 0 9 21 lll5lOT^-r<fcdtc, m^ma7^^'y\•^o 
[0 0 9 31 aiaJl«SJfrSMKS5«. SMIisa-llii 

2t. ■gKiistfyf^iiiists mKl^ip-/^flll4^:l^■5 3 

[0 0 9 4] $/c. SafiSPtix WB5fii5t:«y5^li!)8<!:. B 
BCfii5P-;Ha9i:. ±IK3-$ftl Oil. W^astr-yf^W 

1 1 <!:. H3i»3-an 2t. ^nmrntd-y^FUt st. 
^m^asp-zutt 1 4 #spi 5 tTis^s-ti?., ¥ 

h 1 0 0(^is^ss*jii8i^#tTifjf^sy'(iBiicstfr*§-^ 

[0 0 9 5r$/-c. f*^gPti. •f*$tSPtf>y^ttl5,t. W' 

(iuai. Mmt. i2i3st;ia4^#!i<oc:<t) o 
[0 0 9 6] ^/c. TWL^mi^r^^^ommt. mm 

Ssa-lftl etx JKSSStf'^^ttl 7i:. fl9;BI6i5P-;U 
fill 8 ISBaSse-yf^fllll 9t. SWHIi5t-y^fill2 
Ot. mB^-lm2^t. SgP (£11) 2 2i:TlS^ 
^n^. flSKSS If -yaffil 7<5:flS^li5P-;Hai 8<03S 
.■Stiv *^fiSCUlc«SP#>> H 0 0cr)flaHSi5ffiS:&S 
«-r«t,<7)i-rSo A»<DJS8P (SS) 2 2«. ^KIIC 

*s6«>jic«*MiiC^ap#«> h 1 0 o<DS)iE«-tfpga 
[0097] j.x±*.^g-rn«\ ^ussfiiijic^^Mi 

lbP/1t-y H OO^ftiLTt*^ •&itT-3 + 7x2 + 3 
+ 6X2 = 3 2SdaJg«^^T5c:«!:tc^«o fiU xv 

^-"r-f y-mifom^^mu^^-y hi ooft^-^-r 

Lt> 3 2 SB&)glCPg^7!rni)lRT«%t^ 1511- • mi^± 
[0 0 9 8] ±atL/c<fed&M^»i!lP*'> K 1 0 OAt 

LT3S^$'J^al*^7•p^:<t:^^■<Dgii*^6s T'^^f^ai- 

S^JiK-rSClttLfc, ^«}. COS© 
AlcKlCfflKTrnTl^SltraV 1 1 -3 3 38 6^R^«ffl 



(n) 



1tra2 00 1 -1 5 0 3 7 0 



[0 0 9 9] msiCTjkr^otji^^mmiiii^m^rcmit 

«#BSxrn/cU) o L/c««oTx €tPlil!iaJ<Dtii^ h;l/<7 

[0 10 0] laefcti. p^f?«jP'it-y h 1 0 oomm 

§)^tSa- y h 3 0, 4 0, 5 0R/L, 6 0R/L 

mm^'i^'?mmo.-'y h 8 0 tvm^^H^ (iiu r 

Ji(TPI1i) o 

[01011 Mis;iKi«iP/i?«y h 1 0 o^<*coi!)m*. *'J 

«8iiL->> h8 0(cJ:^T»SSWtci6iJi!Bi^n«, ©JSBIil::: 
•yhSOtiv CPU (Central Process 
i ng Unit) 'J'-y y^ppi^EV - ^'y Zf^CD^^m 

8 1 ii»^s-¥'p*'> h 1 0 0 (D^mmmmt(D7' 

-So 

[0 10 2] *IIS6^JT1is «-^^Bl*. mi(.^W}Ci7t< 
-y h 1 0 0^S3lMlClB»)r^rc«>CD/\"7 7^'J^^/u/£ 
«!fiK (E14l::«El,T^L«:t^) t^oTL^S. ^IcIgiliS 

T-fcnts. wsc^ap<j?-y h 1 0 oco^isM'&f^ifi^ti 

[0 10 3] 0 5lC^Lrclffll^ll!lP?K«y f- 1 0 01*30 

ttg|Si5a-tti2. ■BMii5tf-;/f^$a3. «g5li5P-yHifi4 

gaS5l^-y^lft7'-?^JLX— ? A3. ■eKg5P-;Htt7'^ 

[0 10 4] ^fc. f*f*gpiL-'y h4 0lCtt. •t*:f*SPtf 

^Jl-rStt:$*gI5f>y^lft7":^5^iLX-iS«A5. f*:|$gi5P 
-;H47'-J7^ix— ?A6s tmSPa-teZ-^^ax- 

[0 10 5] $fcx lSm>3--'y hSOR/Lt*, ±»8IL 
h5 1 R/Lt, K5 2R/Li:. b5 

|Rax>y h5 3R/'Llc:jiffl«<b*-n««5. HMastr>y9^ 

fas. mm^u-)m9. ±ffii!a-ttii o. mmw^^-y 

Mm®u-)m^ 2. #aKl®tf>y^fi!ii 



3. ^nm^u-^\^m^ ^oy^^-^^m-t^mmB^-y 

^IftZ'i'^aX— Jf A8x MBBSSP-ZHftT'-J'^iLX- 
^»A9x ±Ba3-$lll7-^f^nx— SfAiOs Mm^\^'yf- 
Wr<Pf■:n.T.—^^^\^. WMSSn-ZUiiT'^^aX-^i 
Ai2> #mglS5tf-yf^$47'^^aX— SfAis. ^mKfiiS 

p T' "? 5^ a X— ? A i4*i«^-n-?'ni3tizrnT 

[0 10 6] $/c. SBigjiX-y h6 0R/Lt*. :*:ffiia5 
ax«y ^6 1 R/Lt. h6 2R/Lt. MSP 

h6 3R/Lici|iffl5^fb*nS)b\ BgB5Sj5a-$fti 
6. ISBBSSl^-y^ail 7. aSBSasp-zl/Wi 1 8. fglBSfiiS 
tf«y^Wl 9. jeMM6i5e-y^$42 0> SM^SSP-yU 

142 1 <DS'!7^aj£-r*flaMgi5a-«i7'^^ax— s« A 

16^ aaBOIiStr-yf^StT'^'g^aX-^JAiy. KHIiSP-^U 
a7''>^aX-'5fAi8x ^Ma5e'>9^$ft7"?5^iX— > 
Ai9s SmKfii5tf->f^$llZ-?5^aX— ?A20^ SMBISS 
P T'^ ^ a X— $J A 21 fi^^tl^'tlffiiiS-tlTl^ 

So 

[0 10 7] §7''?^3.X--SiA2, A3 -1*. 

LT^-- ? • 3.x -y hrt^C^S«^L/^:•S'^'ycD'J^SaAC+^ 
-<tt -7''^^iLX-'5' (*5ai) T^So 

[0 1 0 81 PSPO-X y h3 Os ftl^gpiLX-y h4 0s 
BSgpiLX-y h 5 0> #Pffl5ax-y h 6 0^<t*<OS«l«ia 
X-y hSlC. 7''?5=-aX-^«|gi!j$iJffl)ffl<DS'J$yfflia53 
5, 4 5, 5 5, 6 5 tfi^n^tllBd^-nTl^So *e 

^ stf 9 2%^s-r«<ttt.(c. ■(* 

$fgi5ax-v h 4 oi^(c«. 3S^:&if;ij-rs^^-t>-y-9 
3«^liiiLTtNSo c:n6^-t:>-»t9 1 ~9 3<7)ai^lc 

s*S2 2<oa0i?sifsitfl?iss. f*$?gp»offi*s 

[0 10 91 ±*iJ^gP8 0«> s-fe>-y-9 i~9 3coaj 
^lCj;5SLTiiJ*'JtBISIJ3 5, 4 5, 5 5. eS^S-SJlC 
5*LTji)^;e*)'5:«'JW^tTl\ BP^^BlP/lt'-y h 1 0 0(D 

m^cDi(jf^/\'^'->^pft>"aiLT. jsapiiax zmp 

(Zero Moment P o i n t ) HUts '((I^S 

•ST'^^aX-^'scDJijBT^-^) ^SsiJSWaP3 5, 
4 5, 5 5, 6 5lCfejJS-rS„ ^LT> S-f? WgiJSiJffllgP 
3 5.4 5" T'«, ±*<J«|ISP8 1 6^6<0Sfi=IW K« 
»f?LTs ST'-J^^aX-^fA^ A3 - (c3«tLTffill*iJ 

^aifi^«ai:^-r«o 

[0 110] ccT-m^ rzMPj t^t. mi^poms. 
$fcs rzMPHiilj tit. mPH^a^-y H oo 



(12) 



^Kl 2001-1 50370 



(o^nwirmmtpii <!f »c z m p < wm^mmr 

[0111] PjCiKiJ)P?K'y H 0 01*. a»IE 
*J?»gEtCD)ift#e («iiJ^l#E t h e r n e t ft«!f<D 

mm^i,mmLAN) ^^3^-. i«w3P so Tit's <^ 
^i-myiaigs/)^ e ti.««/xvfiait «fe o T^&T' ^ ^ i 

[0 112] :^(jic. c:<oit»jtiKB)P<K-> H i oolcfcnt 
[0 1 131 ±«iJiai8P8 0»v 3gi5-fe>-9-9 3^<f<D* 

i:<i:^<i^aiLxii¥«js-r« (x^^^ysi i) „ m 

{6|g-b>t»-9 1 Si;9 2luJ:oTe#««Sgfi'JLfcC:t* 
10 1 141 m^^Wiamy h 1 0 oo^&miz^if^ 

§bn^'y b 1 0 0 g#(DSIia6i!SajS(c^(t%3E1&AJS 
^i'JS-r 5 ' t J: o T. g » g #<D^§iJB^<D3e»**'J 
BT-rsc:i:*^T*« (7.7^-y:/Sl 2) , 
[0 1151 i£«iJB#(Di5»««fiJS*n*<!:, iS'JtaiSPS 

:?'s 1 3) o 

[0 116] ^LT. IXtf LfcS*±*^t)»)f^/\°'j!-> 
(c/iSCTx SSPj1B)> ZMP (Zero Moment 

Point) mm. wmmm. ±SimWi. mmm-tis: 

7=^—5') *SI'J*iJ(aig|53 5. 4 5, 5 5. 6 5lC^-r 
* (7.7^'yrs 1 4) o 

[0 117] COSSm. ST'-J^^iX— 5» A2, A3 - « 
|5)SSWlciEBLTv BJiitiKKiP^'y h i 0 0liS*±«< 

y<7)fc«&©^^H5ii8jf^«^si?T-r« (XT^yysi 

5) , 

[0 1181 te§JLTt^«M)5C^®JP?Jt-> H 1 0 OlCdo 

[0 1191 m^^Wia^^-y h 1 0 0««e»lffiBlS!T« 
rH£. ^SfJ^BPS OICJJINT. eiiJ<D*iJ»i. K«iJ5S^(7) 



P<K>y K 1 0 0 6^aPiaifPf^T-Sni#x P'lt';/ h 1 0 0 

t^/cJiS^^i^L A N E thernet-¥>Blu 

e T o o t h) ^^<DjHi#|g*^LTSltlXoTlgib 

[0 12 01 :$immmim^mi^^ma7f('y h 

1 0 0*«§a<Dl£fij5S^/)^e>Se*±*''^/S:i6a)ififP^|ll 
tr-y 5^tt«t> y tOpIIftgp-rGrto-BT'^^^a X— ? A 5* 

[01211 (1 ) 3ofi?-a-m^*^6cos?±3b^y 

EI8~01 3lc(*, *llfi6^Jlc«SKiie^®lP'1t-v h 1 

[0 1 2 21 I2181CI*. PiCi^lftP^K'y h 1 0 0«!-5o 

COJ:3^Sfi!)*5<llT% ^*'J1iBaJ8 0«. i5»42>t>-9 
3^^~©S-b>+fm:^^®lcLT. iS^roiSS5*JaiiKL 

[0 12 31 #6ic. **|J^algp8 oti. m^-tyv9 3 

[0 12 4] E91C». •5ot«-^a)eiij3S^lC*>t>TMl 
^i»aP4?'y h 1 0 0««S*±*i<yil!iff:&Ba5feL/i:«!^^ 

[0 12 51 maiCTjkmmvim-cit. PiC^i»P'it-> 
h 1 oocD«/^:^^as^ip|5H<^^)fiogTt£t^lcfeSo 

tc«> ^■TU'b'iiL^^m^.^^mKmr'^mis^^^o 09 

iKllbP<K-y h 1 0 01*. i5IMMgi5e';'^lfi7'^f^ 
ax— S'ASx iilB*glli5tf->^W7''^^ax— SfAii. 
flstfgptf-y^lftT'^^iX— JfAs. BSBaiSfcf'yf^ttT' 
■J^^aX— Ai7s KSl5try^i*7'^'^ax-^Ai9. 
SU'SmBaSS tf 'i* ^aiT'^'^aX— 5»A 20©*^* =&^t& 

[0 1 2 61 Ell OVit. =Etc. MPBIIiStf y^ttT'^ 
5^:iX-^A8s ■(*^gBe'->^^7"?^iLX— S^As. BS 
Has tf -y ^ttT' ^ i X- •§« A ijGJaiSt^* e ic:*:* < 



(13) 
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[0 1 2 7] 01 1 Bi!SlJStflHiaJ*'!rOS«5eP« 

<»:<!: tic. KlgpcD3gelcgB»l*SJPS)SlCi^tT-r^, 
^Itx ia5MHfii5tf>y9^lftZ'57^iLX-<5'A8s i55MBIfii5 

t;^MSi5e-y ^147''? ^ ax-'? A^9^mWlt^ Ct\Z 

e-yf^iST'^'^ax— $fA sSt/ISBIIfiiS fcf -y ^IlIlT' 9^ 
ax-^Ai9^a:^|5gcD^ffii:L. tt^gPSOTO^&pI 

[0 12 8] IKDi^^. ZMP(Zero Point 
Moment) /)«£^«)^J*PHF*9lC^±lJ:i|XS* tl 
«©T% ffii!g|5*J*S6^68frc:tAi«pJffi<«:«:%c [fit* 

* z M p ^jesp«0iE^«tci^»i* -e-s c t*'«ffliitT'ifec> 

[0 1 2 91 01 2T'l*. »SSP©Jt4S^)S|5®*^6gfri: 
<!:t.(c, S^gptf>y^$47'<7^ai— 5?Ai9^IEil!iLT 

T'-^^aX-^As. pgflSg5a!tf'yf'f47''>9^a.x-'> 
Ai7. iaSi^BPt:°-y^lftZ-5'^ax-'5! Ai9, SMk^yf- 
W7''57^ax— Ji A20*S<S*-<*T't^.5, 
[0 1 3 01 01 3TW, ^•6(CS-i>G*±::&(C}#-6± 

— S'Ai9. iaSSMMSSe'y^t*7''5'^aX— SfA20^^ 

[01311 JW-h> 08-01 3:&fflL>Tltt^L/-cJ:^ 
tc. *IISg«iJlc#«Bgi^igl!jP/1t >y h 1 0 OlcJ:nt#. 

!|toSW^3£*i* Lie) ^^±fi«*c:i«:7**o 

[0 13 2] (2) ffll[Rjtt«^*^S©E*±*i^y 

014'^02O(C». 2|s:||fi&^jicf^%p^i!ia.ir>> h 
1 0 0«5ffi]|p)lttt^6^6ie*±«««fci6cO-a(Dllf^« 
0ftiLTt>-S, 



[0 13 3] 01 4(c(i. m^&nTfsy h 1 0 06'«iq) 
C <;),*: -5 35:l£#Jtt«IT\ ItSUiSISP 8 0 §8^42 V+J- 9 

3*if©s-t>+»-ai^*st5:LTx ii?gtD3e»«iaattL 

[0 13 4] 01 5T«x iE®M. K«iJ3S»*WBiLfc 
IBijC^l(in'1?«y h 1 0 06^ ^q]|S)^t|?i?6^soig*±«« 

Ji9Mfi5t^-y^llll7''?^aX-'SJAi7«SttT*--a-T. fflJ* 

mfig-r*. ?61C. jSSRKISlf'y^iiiT'^'f^ax— SJA 

[0 13 5] 01 6T-(*s ISg|J6^SJ5|5L/c4*^T-?6lC 

paSB5S5tf->^lfi7">^iix— Ai7. M^SPtf-y^lft 
7'^5^a.x-'5i Ai9. iS^StttT-y ^$ft7''5'f^a.x-'5f A 

[0 1 3 6] 01 7TI*. S-Slc. •(*|%e-y^$ftZ'?^ 
ax-^iAs^SffiS-t+^Siil^mj:. ffiSHI5<!:Sa)315S>!?a) 
Sfl58PiJ<Dffi8l^®< LT^,^<o CflJllS^s MiC^illlP 
h(7)a'i:^G)b^±?^^c^•5^3b^y^tB(!*^i:^:t.^!:. z 

[0 1 3 71 01 ST-tt. *eic. IKfiPtMISP^tl^n 

•t±Tl^<<, *6lc. M^g|gi5t°'y9^$ft7"?^ax--S'A 
19^J^i!j5'-t*T«'i:>G^^-6±tf^„ CCOJSII. ZMP 

[0 13 81 *IIS6ff"Jtc#*ffi)3:^«jP'1?y n 0 Olc 
^c:i:(cj:y. ZMP^sg|5lc^-t+S)lE©*^^rttci^ 

f^ax— siA5$*>y(DpriitigiJ^Sffl-r^i::<tT\ ffiasp 

[0 1 3 91 01 9Tli, ffi5SI5^8t^S--y-/c^. #JgL 

^iLX— SiA20^ i5S§SMfi5tf'y^ifi7''5'^ii.x— 
Ai9> P5flSBIgi5tr'y^tt7'^79^ax— SJA17. •f*$^BIIIi5 
" e-y^WT'^'^ax— StAs^lgftx*--!*?), 

[0 14 0] 02OTI*. ?6lcKlg|5^»M*-fe!:SCi: 

«l^^/^^LTt^«. ^tCv ■(«?SPtr'y^fft7''f ^ax- 
•S^As. ia5fla^Ii5tr-y^fft7'-5'^aX-<?Ai7. jS^MBI 
gse-y^ttZ^f^ax— SiAi9, PSSm^SStr-y^^fftZ 
•i^^^aX— ? A20«SCtt*-t*Tt"'So 

[0141] fflJ|^)^t<i:t^53g^^*^ -ssici*, m^m 



(14) 



1$M2 0 0 1 -1 5 0370 



mmmim^m^majf.'y k i o otcj:nifv 

5~I212 0lc.xx-r-il©l(jf^/\°^'->lJ:iK:3T. Rjflc 

to 1 4 2] •WJiS]Jtae»*^eo)S*±««ysi!)f^ 
[0143] ( 3 ) mmvimti^e<omf^±ff' v 

m^^nUT^y h 1 0 0 6'««iEL/c3S»*^6««S^± 

Vlciit o TSf m«8*^e. ilit^Hi^ TSJf-r ^ Jl <!: 3b'<pr 
W^^S«|■r^/c«)<7)i(Jf^^)Ii^^:•r>L^TiJ^B^■r^o *B^!iiffl 

Tmm) o 

[0144] El 2 1 2 6 :^mmmim^mi(. 

f^ap#-y h 1 0 0 6';<lllim^3b^eS*±6'<^fc«)CDl(i 
[0 14 5] 02 1 ft«. iai^s»il!iP?Ky h 1 0 Otm 
[0 1 46] ia22Tl*. g**^«llELTt,^^<l:*'JKfrL 

[0 14 7] I212 37«x i*:$taJ3-fft7''?^aX— ? 
So I^B$lc:£ffiBI6i5tf>>^$ft7'<7^ii.x-^?Ai7 

[0 1 4 81 E2 4T'tis ■f*:$$gP3-$a7''>^aX— 51 
A7t:£IKBIIIiSl^'y ^^fiT*^ X— SI A i7<DlHl|g«8l 

[0 14 9] 02 5Tl*x it^mS-^T^'^o.J:-^ 
A7t:£flS^ii5 tr-y 5^IS7'^ 5^ a. X— ? A i7<DiaiE^SS 



^^ttP'l^'V h 1 0 0©(*^fli:3b'«ffi®^B9ffliJ(C#m>^ 

[0 15 0] ia2 6T'«. «:^aJ3-||ll7'^'^aX— 51 
A7i:«EflSMIi5tr>y ^IftT^^^nx— S« Ai7<^Ih1^:£J{I 
IKS* -e-Zc^mi LT. miU»«lU7t<'y h 1 0 OA-^-pOtt 

ia8~01 3*#^L^««'5Bilcm^L/cJ:^3S:»f^/\* 
^-'yim':>T. m^^Siajfiy h 1 0 0»g»6*Ilc 
(f'Sfc-Si^gBS^erotoSW^ffiSll^LlC) SH$±Ai^S 

[0 15 1] m2 ^ ^m2 6^m^LtSifi^e>meaLrcm 

Vit. ±IC#|^3-W7'^'f^ax— 5iA7©IE»)^f"Jffl 
fco Ctli>X9yic>t. ■ftt?p-yHft7"?^ax--S» A6© 
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(54) LEG-TYPE MOVING ROBOT AND OPERATION CONTROL METHOD 
FOR THE SAME 

(57)Abstract: 

PROBLEM TO BE SOLVED: To provide a leg-type moving robot capable of 
autonomously and smoothly standing up from its various overturning postures 
such as falling on its face, falling on its bacl<, falling on its side or the like. 
SOLUTION: This leg-type moving robot has a degree of freedom on each roll, 
pitch and yaw shaft of a body part. The robot can smoothly stand up from an 
arbitrary overturning posture by using the degree of freedom of the body 
parts. The concentration of the load to a specific part can be prevented by 
reducing the load and the required torque to each movable part excluding the 
body part, and dispersing and averaging the load among the movable parts. 
As a result, the reliability in the operation of the robot can be improved, and 
the energy efficiency in a period of the standing-up operation can be 
improved. 
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CLAIMS 



[Claim(s)] 

[Claim 1] The leg formula mobile robot which consists of membrum inferius 
and the upper part of the body arranged above this membrum inferius at least, 
is a leg formula mobile robot which can move freely by movement of the 
membrum inferius, and is characterized by providing a fall decision means to 
judge whether it fell or not, a means to judge the posture at the time of a fall, 
and a means to perform the rising actuation pattern according to a fall posture. 
[Claim 2] The leg formula mobile robot which consists of membrum inferius 
and the upper part of the body which is arranged above this membrum 
inferius and has a predetermined movable degree of freedom in the truncus 
section at least, is a leg formula mobile robot which can move freely by 



movement of the membrum inferius, and is characterized by to provide a fall 
decision means judge whether it fell or not, a means judge the posture at the 
time of a fall, and a means perform the rising actuation pattern according to a 
fall posture. 

[Claim 3] The leg formula mobile robot which consists of membrum inferius 
and the upper part of the body which is arranged above this membrum 
inferius and has a predetermined movable degree of freedom in the truncus 
section at least, is a leg formula mobile robot which can move freely by 
movement of the membrum inferius, and is characterized by to provide a fall 
decision means to judge whether it fell or not, and a means perform the rising 
actuation pattern accompanied by the variation rate of the movable degree of 
freedom of said truncus section at least at the time of a fall. 
[Claim 4] He is the leg formula mobile robot according to claim 3 which said 
truncus section has the movable degree of freedom of the direction of a 
pitching axis at least, and is characterized by said rising actuation pattern 
using the movable degree of freedom of this truncus section pitching-axis 
direction. 

[Claim 5] He is the leg formula mobile robot according to claim 3 which said 
truncus section has the movable degree of freedom of the direction of a 
yawing axis at least, and is characterized by said rising actuation pattern 
using the movable degree of freedom of this truncus section yawing-axis 
direction. 

[Claim 6] He is the leg formula mobile robot according to claim 3 which said 
truncus section has the movable degree of freedom of roll shaft orientations at 
least, and is characterized by said rising actuation pattern using the movable 
degree of freedom of these truncus section roll shaft orientations. 
[Claim 7] The leg formula mobile robot which consists of membrum inferius 
and the upper part of the body which is arranged above this membrum 
inferius and has a predetermined movable degree of freedom in the truncus 
section at least, is the leg formula mobile robot which can move freely by 
movement of the membrum inferius, and is characterized by to provide a 
means perform the pattern of operation for shifting to other fall postures, at a 
fall decision means judge whether it fell or not, a means judge the posture at 



the time of a fall, and the time of a fall. 

[Claim 8] Said pattern of operation for said truncus section having the 
movable degree of freedom of the direction of a pitching axis at least, and 
shifting to other fall postures is a leg formula mobile robot according to claim 7 
characterized by using the movable degree of freedom of this truncus section 
pitching-axis direction. 

[Claim 9] Said pattern of operation for said truncus section having the 
movable degree of freedom of the direction of a yawing axis at least, and 
shifting to other fall postures is a leg formula mobile robot according to claim 7 
characterized by using the movable degree of freedom of this truncus section 
yawing-axis direction. 

[Claim 10] Said pattern of operation for said truncus section having the 
movable degree of freedom of roll shaft orientations at least, and shifting to 
other fall postures is a leg formula mobile robot according to claim 7 
characterized by using the movable degree of freedom of these truncus 
section roll shaft orientations. 

[Claim 11] The motion-control approach of the leg formula mobile robot which 
consists of membrum inferius and the upper part of the body arranged above 
this membrum inferius at least, is the motion-control approach for the leg 
formula mobile robot which can move freely by movement of the membrum 
inferius, and is characterized by to provide the step which judges whether it 
fell or not, the step which judges the posture at the time of a fall, and the step 
which performs the rising actuation pattern according to a fall posture. 
[Claim 12] The motion-control approach of the leg formula mobile robot which 
consists of membrum inferius and the upper part of the body which is 
arranged above this membrum inferius and have a predetermined movable 
degree of freedom in the truncus section at least , is the motion-control 
approach for the leg formula mobile robot which can move freely by 
movement of the membrum inferius , and is characterized by to provide the 
step which judges whether it fell or not , the step which judges the posture at 
the time of a fall , and the step which performs the rising actuation pattern 
according to a fall posture . 

[Claim 13] The motion-control approach of the leg formula mobile robot which 



consists of membrum inferius and the upper part of the body which are 
arranged above this membrum inferius and have a predetermined movable 
degree of freedom in the truncus section at least, is the motion-control 
approach for the leg formula mobile robot which can move freely by 
movement of the membrum inferius, and is characterized by to provide the 
step which judges whether it fell or not, and the step which performs the rising 
actuation pattern accompanied by the variation rate of the movable degree of 
freedom of said truncus section at least at the time of a fall. 
[Claim 14] It is the motion-control approach of the leg formula mobile robot 
according to claim 13 which said truncus section has the movable degree of 
freedom of the direction of a pitching axis at least, and is characterized by 
said rising actuation pattern using the movable degree of freedom of this 
truncus section pitching-axis direction. 

[Claim 15] It is the motion-control approach of the leg formula mobile robot 
according to claim 13 which said truncus section has the movable degree of 
freedom of the direction of a yawing axis at least, and is characterized by said 
rising actuation pattern using the movable degree of freedom of this truncus 
section yawing-axis direction. 

[Claim 16] It is the motion-control approach of the leg formula mobile robot 
according to claim 13 which said truncus section has the movable degree of 
freedom of roll shaft orientations at least, and is characterized by said rising 
actuation pattern using the movable degree of freedom of these truncus 
section roll shaft orientations. 

[Claim 17] The motion-control approach of the leg formula mobile robot which 
consists of membrum inferius and the upper part of the body which is 
arranged above this membrum inferius and has a predetermined movable 
degree of freedom in the truncus section at least, is the motion-control 
approach for the leg formula mobile robot which can move freely by 
movement of the membrum inferius, and is characterized by to provide the 
step which performs the step which judges whether it fell or not, and the 
pattern of operation for shift to other fall postures at the time of a fall. 
[Claim 18] Said pattern of operation for said truncus section having the 
movable degree of freedom of the direction of a pitching axis at least, and 



shifting to other fall postures is the motion-control approach of the leg formula 
mobile robot according to claim 17 characterized by using the movable 
degree of freedom of this truncus section pitching-axis direction. 
[Claim 19] Said pattern of operation for said truncus section having the 
movable degree of freedom of the direction of a yawing axis at least, and 
shifting to other fall postures is the motion-control approach of the leg formula 
mobile robot according to claim 17 characterized by using the movable 
degree of freedom of this truncus section yawing-axis direction. 
[Claim 20] Said pattern of operation for said truncus section having the 
movable degree of freedom of roll shaft orientations at least, and shifting to 
other fall postures is the motion-control approach of the leg formula mobile 
robot according to claim 17 characterized by using the movable degree of 
freedom of these truncus section roll shaft orientations. 
[Claim 21] It consists of membrum inferius and the upper part of the body 
which is arranged above this membrum inferius and has a predetermined 
movable degree of freedom in the truncus section at least. The step which 
forms the posture which is the motion-control approach of the sake when the 
leg formula mobile robot which can move freely by movement of the 
membrum inferius lying prone, and lapsing into a posture, and is implanted 
only by the arm and the leg at least using the movable degree of freedom of a 
truncus section pitching axis, The step which raises a leg formula mobile 
robot's center of gravity up at least using the movable degree of freedom of a 
truncus section pitching axis. The step which makes small the relative location 
in the implantation parts of an arm and each leg at least using the movable 
degree of freedom of a truncus section pitching axis, the result which the 
implantation parts of an arm and each leg approached enough - said leg 
formula mobile robot's ZMP - a foot - the motion-control approach of the leg 
formula mobile robot characterized by answering having gone into the 
implantation field and providing the step which starts expansion of the whole 
body. 

[Claim 22] It consists of membrum inferius and the upper part of the body 
which is arranged above this membrum inferius and has a predetermined 
movable degree of freedom in the truncus section at least. The step which 



forms the posture which is the motion-control approach of the sake when the 
leg formula mobile robot which can move freely by movement of the 
membrum inferius lapsing into a supine posture, and raised the upper part of 
the body at least using the movable degree of freedom of a hip joint pitching 
axis, The step which moves a leg formula mobile robot's center of gravity 
ahead at least using the movable degree of freedom of a truncus section 
pitching axis, the result which said center of gravity moved ahead enough - 
said leg formula mobile robot's ZMP - a foot -- the motion-control approach of 
the leg formula mobile robot characterized by answering having gone into the 
implantation field and providing the step which starts expansion of the whole 
body. 

[Claim 23] The motion-control approach of the leg formula mobile robot 
characterized by providing the step which consists of membrum inferius and 
the upper part of the body which is arranged above this membrum inferius 
and has a predetermined movable degree of freedom in the truncus section at 
least, is the motion-control approach of the sake when the leg formula mobile 
robot which can move freely by movement of the membrum inferius lapsing 
into a sideslip posture, lies prone at least using the movable degree of 
freedom of a truncus section yawing axis, and shifts to a posture. 
[Claim 24] It consists of membrum inferius and the upper part of the body 
which is arranged above this membrum inferius and has a predetermined 
movable degree of freedom in the truncus section at least. The step which is 
the motion-control approach of the sake when the leg formula mobile robot 
which can move freely by movement of the membrum inferius lapsing into a 
sideslip posture, and floats the upper part of the body from a floor line using 
the movable degree of freedom of truncus section roll axes, The motion- 
control approach of the leg formula mobile robot characterized by providing 
the step which lies prone using the movable degree of freedom of a truncus 
section yawing axis, and shifts to a posture. 

[Claim 25] The motion-control approach of the leg formula mobile robot which 
is the motion-control approach of the sake when consisting of membrum 
inferius and the upper part of the body which is arranged above this 
membrum inferius and has a predetermined movable degree of freedom in 



the truncus section at least, and the leg formula mobile robot which can move 
freely by movement of the membrum inferius lapsing into a supine posture, \ 
and is characterized by providing the step which shifts to a sideslip posture at 
least using the movable degree of freedom of a truncus section yawing axis. 
[Claim 26] It consists of membrum inferius and the upper part of the body 
which is arranged above this membrum inferius and has a predetermined 
movable degree of freedom in the truncus section at least. It is the motion- 
control approach of the sake when the leg formula mobile robot which can 
move freely by movement of the membrum inferius lapsing into a fall posture, 
(a) The step which shifts to a sideslip posture from a supine posture, the step 
which lies prone from (b) sideslip posture and shifts to a posture, (c) - the 
step which lies prone and shifts to a sideslip posture from a posture, the step 
which shifts to a supine posture from (d) sideslip posture, and ** - the motion- 
control approach of the leg formula mobile robot characterized by providing at 
least one inside. 



DETAILED DESCRIPTION 



[Detailed Description of the Invention] 
[0001] 

[Field of the Invention] This invention relates to a realistic robot's mechanism 
constituted by modeling a living body's mechanism and actuation, and relates 
to the mechanism of the leg formula migration mold robot which modeled the 
body mechanism of leg formula migration mold animals, such as Homo 
sapiens and an ape, especially. 

[0002] Furthermore, even if it is the case where this invention has been 
reversed in the midst of walk actuation etc. in detail, the control mechanism of 
the leg formula migration mold robot which can rise by himself is started, and 
especially, it falls, and even if it is suitable and is various postures or the case 
where it lies, it rises by itself, and it is related with the control approach 



mechanism for the leg formula migration mold robot which can resume 

automatically the activity interrupted by fall. 

[0003] 

[Description of the Prior Art] The thing of the machinery which performs 
movement modeled on actuation of human being using the electric or 
magnetic operation is called "robot." It is said that a robot's origin of a word 
originates in ROBOTA (slave machine) of a slab word. Although it was in our 
country that a robot began to spread from the end of the 1960s, the many 
were the industrial robots (industrial robot) in works aiming at automation, full 
automation, etc. of production, such as a manipulator and a carrier robot. 
[0004] Recently, the researches and developments about the leg formula 
mobile robot which imitated the body mechanism of the animal which 
performs 2-pair-of-shoes walks in erect posture, such as Homo sapiens and 
an ape, and actuation progress, and the expectation for utilization has also 
been growing. The leg formula migration by 2-pair-of-shoes erection is 
excellent in the point that the flexible migration of the ability to respond to 
discontinuous walk sides, such as a walk side, a stairway, rise and fall of a 
ladder, etc. which have irregularity on activity paths, such as an irregular 
ground and an obstruction, is realizable, although it compares with a crawler 
type, 4 pairs of shoes or a 6-pair-of-shoes type, etc., and it is unstable and 
attitude control and walk control become difficult. 

[0005] The thing of the leg formula mobile robot which emulated a human 
living body mechanism and actuation is especially called the robot (humanoid 
robot) of "a human form" or "a human mold." A humanoid robot can perform 
assisted living, i.e., exchange of the human activity in various scenes on the 
everyday life of living conditions and others etc. 

[0006] The meaning which studies and develops the robot called a human 
form or a human mold can be grasped from the following two views. 
[0007] One is a human science-view. That is, the robot of the structure similar 
to human being's membrum inferius and/or upper extremity can be made, the 
control approach can be devised, and the mechanism of natural actuation of 
human beings including a walk can be solved in engineering through the 
process of simulating walk actuation of human being. Such a research result 
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could greatly return human engineering, rehabilitation engineering, or sports 
science to progress of other various areas of research treating human being's 
movement mechanism. 

[0008] Another supports a life as human being's partner, namely, is 
development of the robot which supports the human activity in various scenes 
on the everyday life of living conditions and others. In various aspects of 
affairs of human being's living environment, learning from human being, this 
kind of robot needs to learn separately the adaptation approach to human 
being or the environment where individuality is different, and needs to grow up 
to be it further in respect of a function. At this time, the direction where the 
robot is having "a human form", i.e., the same form as human being, or the 
same structure is considered to function effectively, when performing smooth 
communication with human being and a robot. 

[0009] In for example, the case so that the approach of passing through the 
room while avoiding the obstruction which must not be stepped on may be 
taught to a robot in practice Rather than it is having structure where the 
partner who teaches like a crawler type or a 4-pair-of-shoes type robot 
completely differs from himself As for a user (worker), it is easy to teach the 
direction of the 2>pair-of-shoes bipedal robot which is dressing the same far. 
Moreover, it is easy to learn also for a robot (for example, refer to the 
Takanishi work "control of a 2-pair-of-shoes bipedal robot" (Society of 
Automotive Engineers of Japan Kanto branch <quantity **> No,25, 
1996APRIL)). 

[0010] Most of human being's workspaces or habitation space are formed 
according to the body mechanism and behavioral pattern which human being 
called the walk in erect posture by 2 pairs of shoes has. In other words, many 
obstructions exist in the mechanical system of the present condition which 
made the driving gear of a wheel and others the migration means moving in 
human being's dwelling space. However, in order for a mechanical system, 
i.e., a robot, to execute various human activities by proxy and to permeate 
human being's dwelling space deeply further, it is desirable that the movable 
range of a robot is almost the same as it of human being. This is also the 
reason from which a leg formula mobile robot's utilization is expected very 



much. It can be said that it is indispensable to have the gestalt of a human 
mold when a robot raises compatibility with human being's living conditions. 
[001 1] As one of the applications of a humanoid robot, vicarious execution of 
various kinds of difficulty activities in an industrial activity, a production activity, 
etc. is mentioned. For example, it is vicarious execution of the maintenance in 
a nuclear power plant, a thermal power station plant, and a petrochemical 
plant, conveyance and assembly operation of the components in a plant, 
cleaning in a skyscraper, and the risk activity and difficulty activity like the 
rescue in a fire site and others. 

[0012] However, there is not necessarily no need of reproducing faithfully the 
body mechanism and actuation which it is the supremacy theme on a design / 
manufacture the robot which specialized in this kind of industrial use realizing 
a specific application or a specific function, and walk-in-erect-posture animals, 
such as Homo sapiens and an ape, originally have although it is premised on 
a 2-pair-of-shoes walk as a machinery. For example, in order to realize a 
specified use, while strengthening a hand's degree of freedom and moving 
function, restricting degrees of freedom, such as a head made comparatively 
low [ relation ], and the truncus section, the lumbar part (spine etc.), to the 
application of an activity, and omitting ** should approve to some extent. 
Consequently, although unnaturalness may remain as Homo sapiens by the 
exterior of a robot's activity or actuation also in a 2-pair-of-shoes walk and 
******, this point cannot but reach a compromise. 

[0013] Moreover, the application of "symbiosis" with a life adhesion mold, i.e., 
human being, is mentioned rather than assisted living, such as vicarious 
execution of a difficulty activity, as other applications of a humanoid robot. 
This kind of robot reproduces faithfully the mechanism of the whole body 
coordination mold which the animal which performs the walks in erect posture. 
Homo sapiens, an ape, etc., of 2 pairs of shoes originally has of operation, 
and sets it as the supremacy purpose to realize that automatically smooth 
actuation. Moreover, if the high erection animal of the intelligence of Homo 
sapiens, an ape, etc. is emulated at all, the actuation using the limbs is natural 
as a living body, and it is desirable for the power of expression which 
actuation has to be rich. Furthermore, it is required it not only performs 



faithfully the pattern of operation inputted beforehand, but that it should realize 
the lively expression of operation in response to a partner's language and 
attitudes ("it strikes"). [ "it praises" or "he scolding", ] In this semantics, the 
entertainment-oriented humanoid robot which imitated Homo sapiens is 
suitable for just calling it the robot of "a human mold." 
[0014] The body is already equipped with the degree of freedom which goes 
up to hundreds of joints, i.e., hundreds, as everyone knows. Although it is 
desirable to give the almost same degree of freedom in order to give a leg 
formula mobile robot the infinite actuation near Homo sapiens, this is very 
difficult technically. Because, although it is necessary to arrange one actuator 
each at least to one degree of freedom, it is equal [ mounting hundreds of 
actuators on a machinery called a robot ] impossible also from a viewpoint of 
designs, such as weight and size, also from the point of a manufacturing cost. 
Moreover, if there are many degrees of freedom, only in the part, the 
computational complexity for a robot's location and pattern control of 
operation, posture stability control, etc. will increase exponentially. 
[0015] For this reason, it is common to constitute a humanoid robot from 
about dozens joint degrees of freedom far fewer than the body. Therefore, 
how it realizes can call more natural actuation one of the important technical 
problems in a design and control of a humanoid robot using few degrees of 
freedom. 

[0016] For example, it is already clear from viewpoints, such as human 
engineering, that it is important in order that the device which has flexibility 
like a spine may carry out actuation various at the place of a life of human 
being and complicated. Although the application top with the industrial truncus 
joint degree of freedom which means a spine has low existence value, it is 
important for the humanoid robot of the life adhesion mold of entertainment or 
others, in addition — and it is called for that adaptability can be actively 
adjusted according to a situation. 

[0017] moreover, since a center-of-gravity location becomes high while the leg 
formula mobile robot which performs a 2-pair-of-shoes walk in erect posture is 
excellent in the point that flexible walk / transit actuation, such as etc., for 
example, rise and fall of a stairway and an obstruction - getting over - is 



realizable and number of a foot decreases, only in the part, attitude control 
and stable walk control become difficult. Especially, in the case of the robot of 
a life adhesion mold, the posture of the whole body and a stable walk must be 
controlled, expressing richly the natural actuation and the feeling in 
intelligence animals, such as Homo sapiens and an ape, 
[0018] The attitude control about the robot of a type which performs leg 
formula migration by 2-pair-of-shoes walk, and the technique about a stable 
walk are already proposed plentifully. With stable "walk" said here, it can be 
defined as "Moving using a foot, without falling." 

[0019] Posture stability control of a robot is very important when avoiding a 
robot's fall. It is because a considerable effort and time amount are paid in 
order to mean that a fall interrupts the activity which a robot is performing, and 
to rise from tipping condition and to resume an activity. Moreover, it is 
because there is risk of doing fatal damage also in the body of the other party 
which collides with the robot body itself or the falling robot by fall rather than 
anything. Therefore, in a design and development of a leg formula mobile 
robot, posture stability control and the fall prevention at the time of a walk are 
one of the most important technical problems. 

[0020] These moments act on gravity, inertial force, and a list from a walk 
system at a road surface with the acceleration produced in connection with 
gravity and locomotion at the time of a walk. According to so-called 
"d'Alembert's principle", they balance with the floor reaction force as reaction 
from a road surface to a walk system, and the floor-reaction-force moment. As 
a conclusion of dynamic inference, the point (Zero Moment Point), i.e., "ZMP", 
that a pitch and the roll-axes moment serve as zero exists in the vola 
grounding point and side top of the support polygon which a road surface 
forms, or its inside. 

[0021] Many of proposals about posture stability control of a leg formula 
mobile robot or the fall prevention at the time of a walk are used as a norm of 
stability distinction of a walk of this ZMP. The 2-pair-of-shoes walk pattern 
generation based on a ZMP norm can set up the point landing [ vola ] 
beforehand, and has the advantage of being easy to take the kinematic 
constraint of the tip of a foot according to a road surface configuration into 



consideration. 

[0022] For example, to JP,5-305579.A. it is indicating about a leg formula 
mobile robot's walk control unit. A walk control unit given in this official report 
is controlled to make in agreement with desired value the point on the floor 
line where the moment by the floor reaction force when ZMP(ing) namely, 
(ZeroMoment Point) walking serves as zero. 

[0023] Moreover, the leg formula mobile robot given in JP, 5-305581 , A 
constituted, as ZMP had ZMP in the location which has predetermined 
allowances at least from the edge of a support polyhedron (polygon) at the 
time of the interior of a support polyhedron (polygon) or landing, and bed 
leaving. Consequently, even if it receives disturbance etc., only predetermined 
distance has the allowances of ZMP, and improvement in the stability of a 
walk can be aimed at. 

[0024] Moreover, to JP.5-305583,A, it is indicating about the point which 
controls a leg formula mobile robot's walk rate by the ZMP target position. 
That is, a leg formula mobile robot given in this official report detects the 
inclination of the upper part of the body, and is made to change the discharge 
rate of the walk pattern data set up according to the detection value while he 
drives a leg joint using the walk pattern data set up beforehand so that ZMP 
may be made in agreement with a target position. Consequently, when 
unexpected irregularity is stepped on and a robot inclines forward, for 
example, a posture can be recovered by discharge speeding up. Moreover, 
since ZMP can control to a target position, it is convenient even if it changes a 
discharge rate in a double stance phase. 

[0025] Moreover, to JP,5-305585,A, it is indicating about the point which 
controls a leg formula mobile robot's landing location by the ZMP target 
position. That is, a leg formula mobile robot given in this official report 
performs a stable walk by detecting the gap with a ZMP target position and an 
observation location, driving one side or the both sides of the leg so that it 
may be canceled, or driving the leg so that the moment may be detected and 
it may become zero to the circumference of a ZMP target position. 
[0026] Moreover, to JP,5-305586,A, it is indicating about the point which 
controls a leg formula mobile robot's inclination posture by the ZMP target 



position. That is, a leg formula mobile robot given in this official report 
performs a stable walk by driving the leg so that it may become zero, when 
the moment of the circumference of a ZMP target position is detected and the 
moment has arisen. 

[0027] The utmost efforts should be paid in order to avoid the situation of the 
fall of a bipedal robot beforehand. However, when the numbers of a foot are 
few 2-pair-of-shoes bipedal robots, it cannot pass for it to be under the 
situation of saying that it will step toward the 1st step of utilization at last from 
a research phase, and the possibility of a fall cannot especially be eliminated 
completely. 

[0028] Therefore, while suppressing the damage at the time of a fall to the 
minimum it not only taking the cure which prevents a fall, but, it is important 
for early utilization of a leg formula bipedal robot restoration of the activity 
after a fall, i.e., rising of a robot, and to start and to raise dependability of 
operation. 

[0029] "The fall" is unescapable when a robot operates under the living 
conditions of human being who includes various obstructions and unexpected 
situations. First of all, the human being itself falls. Therefore, it is not an 
overstatement although it Is indispensable conditions for having the pattern of 
operation which rises autonomously from the condition which the robot 
reversed to realize a leg formula mobile robot's full automation. 
[0030] For example, in JP,1 1-48170,A, it is dealt with about the problem of a 
fall of a leg formula mobile robot. However, in the situation which is likely to be 
reversed, by controlling to lower a robot's center of gravity, this official report 
does not propose mitigating damage on the body of the other party with which 
a robot and a robot collide as much as possible, and has not made reference 
at all about restoration of the activity after a fall, i.e., rising of a robot, and the 
point which starts and raises dependability of operation. 
[0031] Moreover, the reverse posture is various even if it says a robot "falls" 
earnestly. For example, in the case of the leg formula mobile robot of 2 pairs 
of shoes, it lies prone and there is two or more tipping condition, such as 
supine and sideways. It is inadequate for advocating full automation of 
autonomous rising or a robot that it can rise only from some fall postures and 



there is nothing (for example, it lies prone and rises only from a condition). 
[0032] For example, a leg formula mobile robot as shows drawing 35 is 
considered. The robot which shows in this drawing is a humanoid robot which 
performs the walk in erect posture by 2 pairs of shoes, and consists of a head, 
the truncus section, the membrum-inferius section, and the upper extremity 
section. The leg shall have a degree of freedom required for a walk, and an 
arm shall be equipped with a required degree of freedom in the activity 
assumed. For example, each leg has six degrees of freedom, and each arm 
has four degrees of freedom. Moreover, the truncus section is a core of the 
structure which connects the leg, an arm, and a head. However, in the case of 
the robot which shows illustration, it does not have a degree of freedom in the 
truncus section at all. 

[0033] Generally, the walk in a leg formula mobile robot is realized by 
performing relative migration of the implantation side of the leg, and a center 
of gravity or the central point of the dynamic moment. If it is the case of the 
robot of a 2-pair-of-shoes walk, migration in the predetermined direction will 
be performed by changing a foot on either side to a basis and **** by turns. At 
this time, it is necessary to move a weight alignment or the core of the 
dynamic moment to a basis side, and to move it to a predetermined travelling 
direction fundamentally. These actuation is realized in a leg formula mobile 
robot by the cooperative drive by the joint degree of freedom of each part. In 
the case of the leg formula mobile robot which has six degrees of freedom or 
a degree of freedom beyond it in a biped as shown in drawing 35 , 
respectively, it is possible to move the weight alignment at the time of a walk 
or the core of the dynamic moment only with the degree of freedom of a foot. 
[0034] The condition that the leg formula mobile robot which showed drawing 
35 is standing straight is shown in drawing 36 . In the state of such erection, 
the center-of-gravity location of the robot which saw from the body transverse 
plane is on the core of a biped, and ZMP is in the posture stable zone in the 
middle of [ abbreviation ] both the guide-pegs implantation section. 
[0035] Moreover, the condition of having moved the center of gravity to one 
leg (they being crus sinistrum diaphragmatis at the example shown in this 
drawing) for the walk of this leg formula mobile robot is shown in drawing 37 . 



namely, the roll direction of the left hip and the left leg neck joint section - the 
roll direction of a variation rate, the right hip which ****s in this, and the right 
leg neck joint section — by movement which uses a variation rate as a 
principal component, a robot's center of gravity moves to a crus-sinistrum- 
diaphragmatis side, and ZMP moves into the implantation field of a left leg. 
Consequently, a robot forms the posture which can support a whole pile only 
by crus sinistrum diaphragmatis. Moreover, it can walk by stepping toward the 
travelling direction of a request of the right trail used as ****. 
[0036] In the case of the 2-pair-of-shoes leg formula mobile robot which 
mainly assumed the walk, only the degree of freedom arranged at the leg 
depending on arrangement of a degree of freedom can be walked, and such a 
walk actuation pattern is adopted also on the system in many cases. 
Furthermore, it is common that the degree of freedom is separately arranged 
at the arm or the hand part for the activity which a robot does. Moreover, it 
has a degree of freedom aiming at visual recognition etc. also about a head in 
many cases. 

[0037] On the other hand, about the truncus section, robots, such as a walk 
and an activity, cannot tell an indispensable degree of freedom to the pattern 
of operation made into a key objective. For this reason, most leg formula 
mobile robots currently developed towards the present utilization do not equip 
the truncus section with the degree of freedom, as shown in drawing 35 
(above-mentioned). 

[0038] Here, rising actuation is considered at the time of the fall about the leg 
formula mobile robot of the type which does not equip the truncus section as 
shown in drawing 35 with the degree of freedom. 

[0039] For example, when [ which lies prone and rises from a posture ] shown 
in drawing 38 , a robot's center of gravity is raised by making the pitching axis 
of the both-arms section and both hip joints etc. drive, using an implantation 
part only as an arm and the leg (knee region) first, and subsequently bringing 
the relative distance of both the implantation section close gradually (refer to 
drawing 39 ). 

[0040] Moreover, raising a center of gravity and coincidence are made to 
move a foot ahead (refer to drawing 40 ). consequently, a center of gravity — a 



foot - it moves over an implantation field. ZMP rushes into an implantation 
field, i.e., a posture stable zone, and it becomes possible to separate an arm 
from a floor line (refer to drawing 41 ). Furthermore, the leg (knee-joint 
section) is extended, a center of gravity is raised, and rising actuation is 
completed by things (refer to drawing 42 ). 

[0041] A center of gravity is fully however, unmovable in fact in many cases 
because of problems, such as a movable include angle of each joint, and 
interference between parts. For example, grounding an arm, in case a posture 
is made to shift to drawing 41 from above-mentioned drawing 40 , a knee 
cannot fully be collapsed and ZMP cannot be moved to the implantation field 
of a foot. If migration of ZMP is tried by force, before ZMP rushes into a stable 
zone, an arm cannot carry out bed leaving first and cannot rise well. 
[0042] Moreover, as shown in drawing 43 , when the leg formula mobile robot 
has fallen with the supine posture, it becomes still more difficult for a robot to 
rise autonomously, i.e., nothing [ the physical assistance from the outside ]. 
[0043] When performing rising actuation from a supine posture, a center of 
gravity is raised up by taking first the posture grounded to a floor line by the 
leg and the arm (refer to drawing 44 ). Subsequently, relative distance of an 
implanted foot and an implanted arm is gradually made small (refer to drawing 
45). 

[0044] if the relative distance of a foot and an arm becomes sufficiently small - 
- a robot's center-of-gravity location ~ a foot ~ it can move to the implantation 
field sky (refer to drawing 46 ). In this condition, since ZMP is contained in the 
foot, i.e., a posture stable zone, while separating an arm from a floor line, 
rising actuation completes a center of gravity by raising further by extending 
the leg, i.e., a knee region, (refer to drawing 47 ). 

[0045] However, a center of gravity is fully unmovable in many cases because 
of problems, such as a movable include angle of each joint, and interference 
between parts, as well as the case where lie prone and it rises from a posture 
in fact. For example, grounding an arm, in case a posture is made to shift to 
drawing 46 from above-mentioned drawing 45 , a knee cannot fully be 
collapsed and ZMP cannot be moved to the implantation field of a foot. If 
migration of ZMP is tried by force, before ZMP rushes into a stable zone, an 



arm cannot carry out bed leaving first and cannot rise well. 
[0046] By lying prone, when extending the movable include angle by the side 
of the front face of the body in the hip in any [ of the rising actuation from a 
posture, and the rising actuation from the supine posture which was shown by 
drawing 38 - drawing 42 and which was shown by drawing 43 - drawing 47 ] 
case, the bottleneck shown in drawing 40 and drawing 41 , and a list at 
drawing 46 and drawing 47 is cancelable. However, since interference with 
the truncus section and the member of the circumference of it generates the 
movable include angle of the hip in a sake greatly in the leg formula mobile 
robot of the system, it is hard to call it a realistic solution. 
[0047] moreover, it mentioned above - lying prone — and supine — 
constituting a foot extremely heavily also in the rising actuation pattern from 
which posture - the whole leg formula mobile robot's center-of-gravity location 
- a foot — if it sets up near, even if it is the case where an arm carries out bed 
leaving previously in drawing 41 or drawing 47 , ZMP can be moved to a 
posture stable zone. It is the same principle as DARUMA rises automatically. 
[0048] If it is the case of the robot which performs "******" which always has a 
robot's center of gravity in the touch-down range of the vola during a walk, 
even if the whole center-of-gravity location is located like DARUMA in a low 
place like a foot, stable walk actuation is securable. 

[0049] On the other hand, in the case of the robot of a type which performs 
.1******11 which a robot's center of gravity separates besides the vola, the 
concept of the "handstand pendulum" of aiming at posture recovery by 
accelerating a supporting point strongly is introduced in the fall direction 
during a walk period. That is, in order to enable dynamic center-of-gravity 
migration in the case of a ****** type robot, the leg is designed comparatively 
lightweight to the condition so that it may become a height comparatively 
about a center-of-gravity location. Conversely, if the mass of the leg is large, 
smooth center-of-gravity migration will become difficult, and trouble will be 
caused to the walk itself. If it summarizes, since the posture stability control at 
the time of ****** becomes difficult, it cannot become general solution of the 
leg formula mobile robot which performs rising actuation to set the whole 
robots center-of-gravity location as a low place. 



[0050] Since the good variate of the relative location of an arm. a head, etc. 
and the leg is small when it is the leg formula mobile robot of the type which 
does not have a degree of freedom in the truncus section so that they may be 
known, even if it refers to drawing 43 - drawing 47 in drawing 38 - drawing 42 , 
and a list, rising from any fall posture becomes difficult. 
[0051] On the other hand, the good variate of the relative location of an arm 
and the leg is extensible constituting a robot's truncus section extremely short 
or by constituting an arm extremely long. Consequently, before ZMP as 
shown in drawing 41 or drawing 47 goes into a posture stable zone, the 
phenomenon in which an arm will carry out bed leaving can be canceled, and 
rising actuation can be realized. 

[0052] However, the truncus section will be shortened, or lengthening an arm 
will lose the limbs of a humanoid robot, or the balance of the whole body, and 
it will deviate from the meaning which aims at "a human form" or "a human 
mold." 

[0053] Moreover, a robot's own control unit is carried in the tooth-back section 
in many cases as a trend of the leg formula mobile robot at the time of this 
application. Therefore, since a center-of-gravity location inclines toward a 
tooth-back side greatly when it falls on its back, if the rising actuation from a 
supine posture becomes still more difficult, it will hit on an idea of it (refer to 
drawing 48 ). 
[0054] 

[Problem(s) to be Solved by the Invention] The purpose of this invention is to 
offer the mechanism of the great leg formula migration mold robot which 
modeled the body mechanism of leg formula migration mold animals, such as 
Homo sapiens and an ape. 

[0055] Even if the further purpose of this invention is the case where it has 
fallen in the midst of activities, such as walk actuation, it is to offer the great 
leg formula migration mold robot which can rise by himself, and its control 
mechanism. 

[0056] The further purpose of this invention is to offer the great leg formula 
migration mold robot which can fall, can rise autonomously even if it is 
suitable and is various postures or the case where it lies, and can resume 



automatically the activity interrupted by fall, and its control approach 
mechanism. 

[0057] The further purpose of this invention is to offer the great leg formula 
migration mold robot which can lie prone and can rise certainly and smoothly 
autonomously also from various fall postures, such as supine and sideways, 
and its control mechanism. 
[0058] 

[Means for Solving the Problem] This invention is made in consideration of the 
above-mentioned technical problem. The 1st side face A fall decision means 
to consist of membrum inferius and the upper part of the body arranged above 
this membrum inferius at least, to be the leg formula mobile robot which can 
move freely by movement of the membrum inferius, and to judge whether it 
fell or not, He is the leg formula mobile robot characterized by providing a 
means to judge the posture at the time of a fall, and a means to perform the 
rising actuation pattern according to a fall posture. 

[0059] Moreover, the 2nd side face of this invention consists of membrum 
inferius and the upper part of the body which is arranged above this 
membrum inferius and has a predetermined movable degree of freedom in 
the truncus section at least. It is the leg formula mobile robot which can move 
freely by movement of the membrum inferius, and he is the leg formula mobile 
robot characterized by providing a fall decision means to judge whether it fell 
or not, a means to judge the posture at the time of a fall, and a means to 
perform the rising actuation pattern according to a fall posture. 
[0060] Moreover, the 3rd side face of this invention consists of membrum 
inferius and the upper part of the body which is arranged above this 
membrum inferius and has a predetermined movable degree of freedom in 
the truncus section at least. It is the leg formula mobile robot which can move 
freely by movement of the membrum inferius, and he is the leg formula mobile 
robot characterized by providing a fall decision means to judge whether it fell 
or not, and a means to perform the rising actuation pattern accompanied by 
the variation rate of the movable degree of freedom of said truncus section at 
least at the time of a fall. 

[0061] In the leg formula mobile robot concerning the 3rd side face of this 



invention, said truncus section has the movable degree of freedom of the 
direction of a pitching axis at least, and its hand is also good. In this case, 
said rising actuation pattern can use the movable degree of freedom of this 
truncus section pitching-axis direction. 

[0062] Or said truncus section has the movable degree of freedom of the 
direction of a yawing axis at least, and its hand is also good. In this case, said 
rising actuation pattern can use the movable degree of freedom of this truncus 
section yawing-axis direction. 

[0063] Or said truncus section has the movable degree of freedom of roll shaft 
orientations at least, and its hand is also good. In this case, said rising 
actuation pattern can use the movable degree of freedom of these truncus 
section roll shaft orientations. 

[0064] Moreover, the 4th side face of this invention consists of membrum 
inferius and the upper part of the body which is arranged above this 
membrum inferius and has a predetermined movable degree of freedom in 
the truncus section at least. It is the leg formula mobile robot which can move 
freely by movement of the membrum inferius, and he is the leg formula mobile 
robot characterized by providing a means to perform the pattern of operation 
for shifting to other fall postures, at a fall decision means to judge whether it 
fell or not, a means to judge the posture at the time of a fall, and the time of a 
fall. 

[0065] In the leg formula mobile robot concerning the 4th side face of this 
invention, said truncus section may have the movable degree of freedom of 
the direction of a pitching axis at least. In this case, said pattern of operation 
for shifting to other fall postures can use the movable degree of freedom of 
this truncus section pitching-axis direction. 

[0066] Or said truncus section may have the movable degree of freedom of 
the direction of a yawing axis at least. In this case, said pattern of operation 
for shifting to other fall postures can use the movable degree of freedom of 
this truncus section yawing-axis direction. 

[0067] Or said truncus section may have the movable degree of freedom of 
roll shaft orientations at least. In this case, said pattern of operation for shifting 
to other fall postures can use the movable degree of freedom of these truncus 



section roll shaft orientations. 

[0068] Moreover, the 5th side face of this invention consists of membrum 
inferius and the upper part of the body which is arranged above this 
membrum inferius and has a predetermined movable degree of freedom in 
the truncus section at least. The step which forms the posture which is the 
motion-control approach of the sake when the leg formula mobile robot which 
can move freely by movement of the membrum inferius lying prone, and 
lapsing into a posture, and is implanted only by the arm and the leg at least 
using the movable degree of freedom of a truncus section pitching axis, The 
step which raises a leg formula mobile robot's center of gravity up at least 
using the movable degree of freedom of a truncus section pitching axis, The 
step which makes small the relative location in the implantation parts of an 
arm and each leg at least using the movable degree of freedom of a truncus 
section pitching axis, the result which the implantation parts of an arm and 
each leg approached enough — said leg formula mobile robot's ZMP - a foot - 

- it is the motion-control approach of the leg formula mobile robot 
characterized by answering having gone into the implantation field and 
providing the step which starts expansion of the whole body. 

[0069] Moreover, the 6th side face of this invention consists of membrum 
inferius and the upper part of the body which is arranged above this 
membrum inferius and has a predetermined movable degree of freedom in 
the truncus section at least. The step which forms the posture which is the 
motion-control approach of the sake when the leg formula mobile robot which 
can move freely by movement of the membrum inferius lapsing into a supine 
posture, and raised the upper part of the body at least using the movable 
degree of freedom of a hip joint pitching axis. The step which moves a leg 
formula mobile robot's center of gravity ahead at least using the movable 
degree of freedom of a truncus section pitching axis, the result which said 
center of gravity moved ahead enough ~ said leg formula mobile robot's ZMP 

— a foot — it is the motion-control approach of the leg formula mobile robot 
characterized by answering having gone into the implantation field and 
providing the step which starts expansion of the whole body. 

[0070] Moreover, the 7th side face of this invention consists of membrum 



inferius and the upper part of the body which is arranged above this 
membrum inferius and has a predetermined movable degree of freedom in 
the truncus section at least. It is the motion-control approach of the sake when 
the leg formula mobile robot which can move freely by movement of the 
membrum inferius lapsing into a sideslip posture, and is the motion-control 
approach of the leg formula mobile robot characterized by providing the step 
which lies prone at least using the movable degree of freedom of a truncus 
section yawing axis, and shifts to a posture. 

[0071] Moreover, the 8th side face of this invention consists of membrum 
inferius and the upper part of the body which is arranged above this 
membrum inferius and has a predetermined movable degree of freedom in 
the truncus section at least. The step which is the motion-control approach of 
the sake when the leg formula mobile robot which can move freely by 
movement of the membrum inferius lapsing into a sideslip posture, and floats 
the upper part of the body from a floor line using the movable degree of 
freedom of truncus section roll axes, It is the motion-control approach of the 
leg formula mobile robot characterized by providing the step which lies prone 
using the movable degree of freedom of a truncus section yawing axis, and 
shifts to a posture. 

[0072] Moreover, the 9th side face of this invention consists of membrum 
inferius and the upper part of the body which is arranged above this 
membrum inferius and has a predetermined movable degree of freedom in 
the truncus section at least. It is the motion-control approach of the sake when 
the leg formula mobile robot which can move freely by movement of the 
membrum inferius lapsing into a supine posture, and is the motion-control 
approach of the leg formula mobile robot characterized by providing the step 
which shifts to a sideslip posture at least using the movable degree of 
freedom of a truncus section yawing axis. 

[0073] Moreover, the 10th side face of this invention consists of membrum 
inferius and the upper part of the body which is arranged above this 
membrum inferius and has a predetermined movable degree of freedom in 
the truncus section at least. It is the motion-control approach of the sake when 
the leg formula mobile robot which can move freely by movement of the 



membrum inferius lapsing into a fall posture, (a) The step which shifts to a 
sideslip posture from a supine posture, the step which lies prone from (b) 
sideslip posture and shifts to a posture, (c) — the step which lies prone and 
shifts to a sideslip posture from a posture, the step which shifts to a supine 
posture from (d) sideslip posture, and ** - it is the motion-control approach of 
the leg formula mobile robot characterized by providing at least one inside. 
[0074] 

[Function] The leg formula mobile robot concerning this invention has a 
degree of freedom on each shaft, such as a roll, a pitch, and a yaw, in the 
truncus section. In the fall posture of arbitration, rising actuation is easily 
[ smoothly and ] realizable by utilizing the degree of freedom of these truncus 
section. 

[0075] According to the leg formula mobile robot concerning this invention, the 
burdens and demand torque to moving part other than the truncus section are 
mitigated by applying the degree of freedom of the truncus section at the time 
of rising actuation. Moreover, the concentrated load to a specific part is 
avoidable by distributing and equalizing a load burden among each moving 
part. Consequently, while improving the dependability of robot employment, 
the energy efficiency in a rising actuation period improves. 
[0076] Moreover, according to the leg formula mobile robot concerning this 
invention, easier rising actuation can be alternatively performed by carrying 
out the sequential shift of two or more fall postures. 

[0077] Moreover, according to the leg formula mobile robot concerning this 
invention, superficial migration can be realized by repeating two or more fall 
postures successively, without rising. Consequently, rising actuation can be 
performed after moving to the location which can start more easily. 
[0078] Moreover, according to the leg formula mobile robot concerning this 
invention, since a fall posture can be changed, the class and number of rising 
actuation patterns which must be supported can be reduced. 
[0079] For example, when the robot prepares the rising actuation pattern 
beforehand, it becomes mitigable [ compaction of a development cycle, or 
development cost ] by reduction of the number of patterns of operation. 
Moreover, since the burden of hardware is also mitigated by reduction of the 



number of patterns of operation, improvement in the part system is expected 
by it. 

[0080] Moreover, when a robot generates the pattern of operation according 
to a situation autonomously, and the number of patterns of operation which 
should be generated decreases, the burden of the arithmetic unit which 
should be carried in the robot itself is mitigated, and reduction of equipment 
manufacture cost, improvement in the dependability at the time of robot 
operation, etc. are expected. 

[0081] Moreover, according to the leg formula mobile robot concerning this 
invention, a rising actuation pattern can be limited by changing a fall posture. 
Consequently, the demand to an output torque, operating range, etc. of each 
actuator required for rising actuation is mitigated. Consequently, while the 
degree of freedom of a design improves, compaction of a development cycle, 
reduction of manufacture cost, etc. are realizable. 

[0082] Moreover, since the approach of rising by changing a fall posture can 
be limited, the power consumption of the robot in a rising actuation period can 
be saved, and the load to supply power sources, such as a dc-battery, can be 
lessened. Consequently, dc-battery drive time amount extends, continuous 
running of long duration becomes more possible by one charge, and a robot's 
working hours, workspace, a work content, etc. are expanded. Moreover, 
since required power resource are also reduced, small and lightweight-ization 
of a dc-battery are attained, and the degree of freedom of a design improves. 
Moreover, since the requirement specification of a dc-battery mitigates, a dc- 
battery unit price can be held down cheaply and the manufacture cost and 
operation cost of the whole system can be saved. 

[0083] The purpose, the description, and advantage of further others of this 
invention will become [ rather than ] clear by detailed explanation based on 
the example and the drawing to attach of this invention mentioned later. 
[0084] 

[Embodiment of the Invention] Hereafter, the example of this invention is 
explained in detail, referring to a drawing. 

[0085] Signs that signs that the leg formula mobile robot 100 of "the human 
form" with which operation of this invention is presented, or "a human mold" 



was standing straight were viewed from each of the front and back are shown 
in drawing 1 and drawing 2 . The leg formula mobile robot 100 consists of the 
membrum inferius of two pairs of right and left which perform leg formula 
migration, the truncus section, an upper extremity on either side, a head, and 
a control section as illustration. 

[0086] the membrum inferius of each right and left consists of a femoral region, 
a knee joint, a leg part, an ankle, and ****, and is connected by the hip joint at 
the abbreviation lowest edge of the truncus section, moreover, the upper 
extremity of each right and left consists of an overarm, an elbow joint, and a 
forearm, and is connected by the shoulder joint in right-and-left each upper 
side edge of the truncus section. Moreover, the head is connected in the 
center of the abbreviation best edge of the truncus section by the neck joint. 
[0087] Control sections are the controller (main control section) which 
processes the external input from drive control of each joint actuator, each 
sensor (after-mentioned), etc. which constitutes this leg formula mobile robot 
100, and a case carrying the peripheral devices of a power circuit and others. 
In addition to this, the control section may contain the communication link 
interface and communication device for remote operation. Moreover, although 
it is the appearance to which the leg formula mobile robot 100 carries a 
control section on the back on the back in the example shown in drawing 1 
and drawing 2 , especially the installation of a control section is not limited. 
[0088] As one of the descriptions of the leg formula mobile robot 100 
concerning this example, it is the point that the truncus section is equipped 
with the joint degree of freedom. When the leg formula mobile robot 100 
coexists with human being, it is important in order that the device which has 
flexibility like a spine may carry out various and complicated actuation in 
human being's living conditions and dwelling space (above-mentioned). The 
joint degree of freedom of this truncus section is equivalent to a "spine", if it 
says by human being. 

[0089] The configuration of the leg formula mobile robot's 100 truncus section 
is expanded and drawn on drawing 3 and drawing 4 . 
[0090] As shown in this drawing, the truncus section joint is equipped with 
three joint degrees of freedom called truncus section roll axes, a truncus 



section pitching axis, and a truncus section yawing axis. For example, the leg 
formula mobile robot's 100 upper part of the body can be shaken at right and 
left to the membrum inferius by the drive of truncus section roll axes. 
Moreover, the leg formula mobile robot's 100 posture can be made crooked in 
the shape of "a character of **" in a sagittal plane by driving a truncus section 
pitching axis. Moreover, by the drive of a truncus section yawing axis, a leg 
formula mobile robot's upper part of the body can rotate relatively to the 
membrum inferius, and the appearance which made the body twist can be 
formed. 

[0091] Moreover, the joint degree-of-freedom configuration which this leg 
formula mobile robot 100 possesses is typically shown in drawing 5 . 
[0092] As shown in drawing 5 , the leg formula mobile robot 100 consists of 
the truncus sections which connect the upper part of the body including two 
arms and a head 1, the membrum inferius which consists of the two legs 
which realize migration actuation, and an upper extremity and the membrum 
inferius. 

[0093] The neck joint which supports a head 1 has three degrees of freedom 
called the neck joint yawing axis 2, the neck joint pitching axis 3, and the neck 
joint roll axes 4. 

[0094] Moreover, each arm consists of the shoulder-joint pitching axis 8, the 
shoulder-joint roll axes 9, the overarm yawing axis 10, the elbow-joint pitching 
axis 11, the forearm yawing axis 12, a wrist joint pitching axis 13, wrist joint 
roll axes 14, and a hand part 15. A hand part 15 is the structure of the many 
joints and many degrees of freedom containing two or more fingers in fact. 
However, since there are little the contribution and effect to posture stability 
control or walk motion control of a robot 100, the actuation of a hand part 15 
itself assumes in this example that it is a zero degree of freedom. Therefore, 
in this example, each arm will have seven degrees of freedom. 
[0095] Moreover, the truncus section has three degrees of freedom called the 
truncus section pitching axis 5, the truncus section roll axes 6, and the truncus 
section yawing axis 7 (refer to drawing 3 and drawing 4 in the above- 
mentioned and a list). 

[0096] Moreover, each leg which constitutes the membrum inferius consists of 



the hip joint yawing axis 16, the hip joint pitching axis 17, the hip joint roll axes 
18, the knee-joint pitching axis 19, an ankle joint pitching axis 20, joint roll 
axes 21, and a foot (vola) 22. The intersection of the hip joint pitching axis 17 
and the hip joint roll axes 18 shall define the hip joint location of the. robot 100 
concerning this example. In fact, although the foot (vola) 22 of the body is the 
structure containing the vola of many joints and many degrees of freedom, the 
vola of the leg formula mobile robot 100 concerning this example makes it a 
zero degree of freedom. Therefore, at this example, each leg consists of six 
degrees of freedom. 

[0097] If the above is summarized, as the leg formula mobile-robot 100 whole 
concerning this example, it will have 2= 3+7x2+3+6x32 degree of freedom in 
total. However, the leg formula mobile robot 100 for entertainment is not 
necessarily limited to 32 degrees of freedom. It cannot be overemphasized 
that a degree of freedom, i.e., the number of joints, can be suitably fluctuated 
according to a constraint, requirement specification, etc. on a design / 
manufacture. 

[0098] The degree of means is mounted using an actuator in fact each one 
which the leg formula mobile robot 100 which mentioned above has. As for 
the request of eliminating an excessive swelling by the exterior and making it 
approximate in the shape of [ human ] a natural bodily shape, performing 
attitude control to the unstable structure called a 2-pair-of-shoes walk to an 
actuator, it is desirable that it is small and lightweight. In this example, we 
decided to carry the small AC servo actuator of the type which was a gear 
direct attachment type, and one-chip-ized the servo control system and was 
built in the motor unit. In addition, it is indicated about this kind of AG servo 
actuator by the Japanese-Patent-Application-No. No. 33386 [ 1 1 to ] 
specification already transferred, for example to these people. 
[0099] The leg formula mobile robot 100 having a degree-of-freedom 
configuration as shown in drawing 5 has arrangement which carries out 
possible ** of the return from almost all fall postures, i.e., the rising actuation, 
beforehand supposing falling (please refer to the after-mentioned for details). 
Therefore, it is desirable to also set the output torque of each moving part as 
the specification which took into consideration the return actuation from a fall 



posture. 

[0100] The leg formula mobile robot's 100 control-system configuration is 
typically shown in drawing 6 . As shown in this drawing, the leg formula 
mobile robot 100 consists of each device units 30 and 40 expressing human 
being's limbs, 50 R/L, 60 R/L, and a control unit 80 that performs adaptive 
control for realizing coordination actuation between each device unit (however, 
each of R and L is a suffix which shows each of the right and the left.), the 
following — the same . 

[0101] Actuation of the leg formula mobile-robot 100 whole is controlled by the 
control unit 80 in generalization. A control unit 80 consists of circumference 
circuits 82 including the interface (neither is illustrated) which performs the 
data of the main control section 81 which consists of main circuit components 
(not shown), such as a CPU (Central Processing Unit) chip and a memory 
chip, and each component of a power unit or a robot 100, and transfer of a 
command. 

[0102] In this example, the power unit has composition (not shown to drawing 
4 ) containing the dc-battery for driving the leg formula mobile robot 100 
independently. If it is an independence drive mold, the leg formula mobile 
robot's 100 physical radius of action cannot receive the limit by the power 
cable, but can walk it freely. Moreover, at the time of various kinds of 
movements including the upper extremity of a walk or others, it becomes 
unnecessary to take interference with a power cable into consideration, and 
motion control becomes easy. 

[0103] Each joint degree of freedom in the leg formula mobile robot 100 which 
showed drawing 5 is realized by the actuator corresponding to each. That is, 
the neck joint yawing-axis actuator A2 expressing each of the neck joint 
yawing axis 2, the neck joint pitching axis 3, and the neck joint roll axes 4, 
neck joint pitching-axis actuator A3, and neck joint roll-axes actuator A4 are 
arranged in the head unit 30, respectively. 

[0104] Moreover, truncus section pitching-axis actuator A5 expressing each of 
the truncus section pitching axis 5, the truncus section roll axes 6, and the 
truncus section yawing axis 7, the truncus section roll-axes actuator A6, and 
the truncus section yawing-axis actuator A7 are arranged by the truncus 



section unit 40, respectively, 

[0105] Moreover, although subdivided by overarm unit 51 R/L, elbow-joint unit 
52 R/L, and forearm unit 53 R/L. arm unit 50 R/L The shoulder-joint pitching- 
axis actuator A8, shoulder-joint roll-axes actuator A9 expressing each of the 
shoulder-joint pitching axis 8, the shoulder-joint roll axes 9, the overarm 
yawing axis 10, the elbow-joint pitching axis 11, the elbow-joint roll axes 12, 
the wrist joint pitching axis 13, and the wrist joint roll axes 14, The overarm 
yawing-axis actuator A10, the elbow-joint pitching-axis actuator A1 1 , the 
elbow-joint roll-axes actuator A12, the wrist joint pitching-axis actuator A13, 
and the wrist joint roll-axes actuator A14 are arranged, respectively. 
[0106] Moreover, although subdivided by femoral region unit 61 R/L, knee unit 
62 R/L, and leg part unit 63 R/L, leg unit 60 R/L The hip joint yawing-axis 
actuator A1 6 expressing each of the hip joint yawing axis 16, the hip joint 
pitching axis 17, the hip joint roll axes 18, the knee-joint pitching axis 19, the 
ankle joint pitching axis 20, and the ankle joint roll axes 21, the hip joint 
pitching-axis actuator A1 7, the hip joint roll-axes actuator A18, The knee-joint 
pitching-axis actuator A1 9, the ankle joint pitching-axis actuator A20, and the 
ankle joint roll-axes actuator A21 are arranged, respectively. 
[0107] Each actuator A2 and A3- are the small AC servo actuators (above- 
mentioned) of the type which was a gear direct attachment type, and one- 
chip-ized the servo control system and was more preferably carried in the 
motor unit 

[0108] The sub control sections 35, 45, 55, and 65 for actuator drive control 
are arranged, respectively for every device unit, such as the head unit 30, the 
truncus section unit 40, the arm unit 50, and each leg unit 60. furthermore, 
each leg 60 — while equipping with the touch-down check sensors 91 and 92 
which detect whether the vola of R and L was implanted, the attitude sensor 
93 which measures a posture is equipped in the truncus section unit 40. With 
the output of each [ these ] sensors 91-93, the inclination of implantation and 
the bed leaving period of the vola 22, and a truncus part etc. can be detected, 
and control objectives can be amended dynamically. 

[0109] The main control section 80 can answer the output of each sensors 91- 
93, can perform accommodative control to each of the sub control sections 35, 



45, 55, and 65, and can realize actuation with which the leg formula mobile 
robot's 100 upper extremity, the truncus, and the membrum inferius 
cooperated, the main control section 81 - a user command etc. following - 
a predetermined pattern of operation - calling - a foot - while setting up 
movement, a ZMP (Zero Moment Point) orbit, truncus movement, upper 
extremity movement, lumbar part height, etc., the command (namely, 
directions data to an actuator) which directs actuation according to these 
contents of a setting is transmitted to each sub control sections 35, 45, 55, 
and 65. And in each sub control section 35 and 45 the receiving command 
from the main control section 81 is interpreted, and a drive control signal is 
outputted to each actuator A2 and A3—. 

[01 10] "ZMP" said here is a point on the floor line where the moment by the 
floor reaction force during a walk serves as zero, and a "ZMP orbit" means the 
locus to which ZMP moves during a robot's 100 walk actuation period etc. 
[0111] In addition, the leg formula mobile robots 100 may be any of an 
autonomous drive mold or a remote-operation mold. In the case of the latter, 
they are each actuator A2 and A3 by the indicated value supplied to drawing 6 
including means of communications (for example, a cable or wireless LAN, 
such as Ethernet) with the communication link interface and external control 
unit which are not illustrated not from the main control section 80 but from an 
external control unit. - Processing of drive control or a sensor output can be 
performed. 

[0112] Next, the actuation at the time of the fall in this leg formula mobile robot 
100 and the procedure of processing are explained. The operations sequence 
at the time of the leg formula mobile robot's 100 fall is roughly shown in 
drawing 7 in the format of a flow chart. 

[01 13] The main control section 80 detects or judges having deviated from the 
usual posture and having resulted in the fall based on each sensor output, 
such as an attitude sensor 93, (step S1 1). For example, it can judge that self 
fell by the difference of the posture which was being planned and an actual 
posture, and the installation check sensors 91 and 92 of the vola. 
[01 14] The general posture at the time of the leg formula mobile robot's 100 
fall corresponds to sideways [ "lie prone", "look up" or up, or sideways / 



"sideways" ]. The direction over the gravity direction in an attitude sensor 
installation part is detectable with the output of an attitude sensor 93. The 
posture at the time of its own fall can be judged by combining and measuring 
whenever [ in each joint degree of freedom of leg formula mobile-robot 100 
self / displacement angle ] (step S12). 

[011 5] If the posture at the time of a fall is judged, the main control section 80 
will lie prone, and will call the rising actuation pattern according to each fall 
posture, such as supine and a sideslip, or will generate a rising actuation 
pattern by data processing (step SI 3). 

[0116] and the acquired rising actuation pattern -- responding - a foot - while 
setting up movement, a ZMP (Zero Moment Point) orbit, truncus movement, 
upper extremity movement, lumbar part height, etc., the command (namely, 
directions data to an actuator) which directs actuation according to these 
contents of a setting is transmitted to each sub control sections 35, 45, 55, 
and 65 (step S14). 

[01 17] Consequently, each actuator A2 and A3— are driven synchronous, and 
the leg formula mobile robot 100 performs whole body coordination actuation 
for rising (step SI 5). 

[0118] Though a required rising actuation pattern is natural in the leg formula 
mobile robot 100 which has fallen, although it is various, this point is 
explained in detail by the after-mentioned by the reversed posture. 
[0119] If the leg formula mobile robot 100 is an autonomous drive mold, in the 
main control section 80, it is necessary to perform decision of a fall, 
judgments of a fall posture, setup of a rising actuation pattern, and all the 
control of rising actuation. However, if the leg formula mobile robot 100 is a 
remote-operation mold, fall decision of a robot 100, the judgment of a fall 
posture, generation of a rising actuation pattern, etc. can be processed on an 
external device, and the indicated value based on these processings can be 
received and driven through means of communications, such as LAN (for 
example, Ethernet and BlueTooth). 

[0120] Subsequently, it explains in detail about operations sequence for the 
leg formula mobile robot 100 concerning this example to rise from various 
kinds of fall postures, being possible in flexible center-of-gravity migration by 



utilizing in this example, the moving part, i.e., actuator A5, of the 
circumference of the pitching axis prepared in the truncus section, — carrying 
out - with - **** - please understand enough the point of realizing rising 
actuation. 

[0121] (1) A series of actuation for the leg formula mobile robot 100 which lies 
prone and is applied to this example at rising drawing 8 from a condition - 
drawing 13 lying prone, and rising from a condition is illustrated. 
[0122] The condition immediately after falling to a floor line with the posture in 
which the leg formula mobile robot 100 lies prone is shown in drawing 8 . By 
such tipping condition, the main control section 80 detects or judges having 
deviated from the usual posture based on each sensor output, such as an 
attitude sensor 93, and hiaving resulted in the fall. 

[0123] [0124] the leg formula mobile robot 100 can judge it to be that it is in 
tipping condition with the posture of "lie prone" now when the main control 
section 80 measures whenever [ in each joint degree of freedom / 
displacement angle ] while detecting the direction over the gravity direction in 
an attitude sensor installation part with the output of an attitude sensor 93 
[furthermore, ] In the fall posture which lies prone, the leg formula mobile 
robot 100 shows signs that rising actuation was started to drawing 9 . 
[0125] In the tipping condition shown in drawing 8 , the leg formula mobile 
robot's 100 center-of-gravity location is located in the lowest location near a 
floor line. In order to rise from tipping condition and to return to the stable 
erection posture, it is necessary to return a center-of-gravity location to a high 
condition first. In the example of a posture shown in drawing 9 , the center of 
gravity G is moved up gradually, supporting the whole body by the arm and 
the leg. At this time, the leg formula mobile robot 100 mainly does the 
variation rate of each of the both-shoulders joint pitching-axis actuator A8, 
both the elbow-joints pitching-axis actuator A11, truncus section pitching-axis 
actuator A5, the hip joint pitching-axis actuator A1 7, the knee region pitching- 
axis actuator A1 9, and the ankle joint pitching-axis actuator A20. 
[0126] At drawing 10 , the location of a center of gravity G is mainly further 
raised up by enlarging further the variation rate of the both-shoulders joint 
pitching-axis actuator A8, truncus section pitching-axis actuator A5, and the 



hip joint pitching-axis actuator A1 7. Moreover, distance of the implantation 
part by the arm and the implantation part by the leg is shortened gradually. 
Although the implantation part of an arm is the tip (hand part) and the 
implantation part of the leg has become a guide-peg flat-point edge (tiptoe) in 
the example shown in this drawing, it is not limited to especially these. 
[0127] in drawing 1 1 , distance of an arm and the implantation part of each leg 
is shortened further, consequently the center of gravity G is moved toward the 
upper part of **** (namely, posture stable zone). Moreover, while the 
implantation part of an arm becomes only at the tip (hand), the implantation 
part of the leg shifts to the **** vola. It mainly shifts from the posture shown in 
drawing 1 1 by driving the both-shoulders joint pitching-axis actuator A8, both 
the elbow-joints pitching-axis actuator A11, truncus section pitching-axis 
actuator A5, both the hip joint pitching-axis actuator A17, and the knee-joint 
pitching-axis actuator A1 9. By making truncus section pitching-axis actuator 
A5 and the knee-joint pitching-axis actuator A1 9 into the maximum variation 
rate, making the truncus section and a knee region crooked as much as 
possible, and making distance to a center of gravity G and the vola below into 
the die length of an arm especially, it becomes possible to make both knee 
regions insert between the both-arms sections, and center-of-gravity migration 
is performed smoothly. 

[0128] Consequently, since ZMP (Zero Point Moment) is completely held in 
the implantation field of ****, it becomes possible to separate an arm from a 
floor line, the posture to which an arm and the leg were implanted in the 
example given in the column of [Description of the Prior Art] since a robot did 
not have a degree of freedom in the truncus section — ZMP — a foot ~ it was 
difficult to have made it move to an implantation field. In this example, since 
the truncus section is equipped with the pitching-axis degree of freedom, a 
posture as shown in drawing 11 becomes possible. 
[0129] By drawing 12 , while separating the tip of an arm from a floor line, 
signs that the center of gravity G is raised further up are shown by driving 
both the knee region pitching-axis actuator A19, and extending the leg. The 
variation rate of truncus section pitching-axis actuator A5, both the hip joint 
pitching-axis actuator A17, both the knee region pitching-axis actuator A1 9. 



and the ankle pitching-axis actuator A20 is mainly carried out. 
[0130] By drawing 13 , a center of gravity G is raised further up, and signs that 
the erection posture is approached are shown. The variation rate of truncus 
section pitching-axis actuator A5, both the hip joint pitching-axis actuator A1 7, 
both the knee-joints pitching-axis actuator A19, and both the ankle joint 
pitching-axis actuator A20 is nnainly carried out. 

[0131] As mentioned above, as explained using drawing 8 - drawing 13 , 
according to the leg formula mobile robot 100 concerning this example, it can 
rise autonomously (namely, he has no physical exchange from the outside) 
from the fall posture which lies prone. Please care about enough the point that 
the variation rate of a truncus section pitching axis is an important element, in 
rising actuation. 

[0132] (2) In rising drawing 14 from a supine condition - drawing 20 , a series 
of actuation for the leg formula mobile robot 100 concerning this example to 
rise from a supine condition is illustrated. 

[0133] The condition immediately after the leg formula mobile robot 100 falls 
to a floor line with a posture with the face upward is shown in drawing 14 . By 
such tipping condition, the main control section 80 detects or judges having 
deviated from the usual posture based on each sensor output, such as an 
attitude sensor 93, and having resulted in the fall. 

[0134] By drawing 15 , the leg formula mobile robot 100 which judged the fall 
posture shows after the fall signs that the rising actuation from a supine 
posture was started. That is, the variation rate of both the hip joint pitching- 
axis actuator A1 7 is mainly carried out, and a posture which is relatively 
implanted by the lifting and the lumbar part in the upper part of the body is 
formed. Furthermore, the both-shoulders joint pitching-axis actuator A8 is 
made to drive, and the preparations implanted by the both-arms section are 
made. 

[0135] Drawing 16 shows signs that the variation rate of the leg is further 
carried out where the lumbar part is implanted. Both the hip joint pitching-axis 
actuator A1 7, both the knee region pitching-axis actuator A1 9, and both the 
ankle pitching-axis actuator A20 are operated, and, more specifically, the 
posture implanted by the vola of both **** is prepared. 



[0136] in drawing 17 . further, distance of the implantation part of an arm and 
each leg is shortened at the same time it carries out the variation rate of 
truncus pitching-axis actuator A5. Consequently, while a leg formula mobile 
robot's center of gravity G begins to occur up, ZMP begins to move toward the 
leg gradually. 

[0137] At drawing 18 , ZMP is further brought near by the foot by shortening 
distance of the implantation parts of an arm and each leg. Furthermore, both 
the knee-joints pitching-axis actuator A19 is made to drive, and a center of 
gravity G is raised. Consequently, since ZMP rushes in into a vola 
implantation field, it becomes possible to separate an arm and the lumbar part 
from a floor line, 

[0138] According to the leg formula mobile robot 100 concerning this example, 
ZMP can be brought near by the foot and it can be made to shift in a vola 
implantation field by forming the posture which the truncus was crooked to the 
maximum extent and inclined forward. That is, please understand enough the 
point that bed leaving of an arm and the lumbar part can be carried out by 
utilizing the moving part of the circumference of truncus section pitching-axis 
actuator A5. 

[0139] In drawing 19 , after carrying out bed leaving of the arm, the location of 
a center of gravity G is further raised by forming the posture which extended. 
Both the ankle joint pitching-axis actuator A20, both the knee-joints pitching- 
axis actuator A1 9, both the hip joint pitching-axis actuator A1 7, and truncus 
joint pitching-axis actuator A5 are made to mainly drive at this time. 
[0140] By drawing 20 , a center of gravity G is raised up by extending the leg 
further, and signs that the erection posture is approached are shown. The 
variation rate of truncus section pitching-axis actuator A5, both the hip joint 
pitching-axis actuator A1 7, both the knee-joints pitching-axis actuator A1 9, 
and both the ankle joint pitching-axis actuator A20 is mainly carried out. 
[0141] Generally the posture of supine is one of the tipping condition to which 
a leg formula mobile robot cannot rise easily. According to the leg formula 
mobile robot 100 concerning this example, according to a series of patterns of 
operation shown in drawing 15 - drawing 20 , it can rise smoothly by using the 
moving part of the circumference of the pitching axis of the truncus section. 



That is, by preparing one or more movable degrees of freedom in the truncus 
section, the rising actuation from a fall posture is attained, or it easy-izes. 
[0142] In addition, it hits on an Idea of the pattern of operation which rises 
after the rising actuation from a supine posture sideslips further and changes 
a posture besides the pattern of operation which rises in the direction of the 
front face of the body which was mentioned above. About the latter, it explains 
in detail behind. 

[0143] (3) Even if it is difficult to rise directly from the posture into which the 
rising leg formula mobile robot 100 from a sideslip condition sideslipped, it is 
possible to return from tipping condition to an erection condition according to 
one of the patterns of operation mentioned above by lying prone from a 
sideslip posture or, for example, once changing into the condition in which 
rising actuation, such as supine, is possible. Here, the operations sequence 
for lying prone from a sideslip condition and changing into a condition 
autonomously is explained, please understand that the sideslip condition 
treated on these specifications is bilateral symmetry (the following - the 
same). 

[0144] In drawing 21 - drawing 26 , an example of a pattern of operation for 
the leg formula mobile robot 100 concerning this example to rise from a 
sideslip condition is illustrated. Fundamentally, this rising actuation pattern lies 
a fall posture prone by using the moving part of the circumference of a truncus 
section yawing axis, and is changed to a condition. 

[0145] The condition immediately after the leg formula mobile robot 100 falls 
to a floor line with a sideslip posture is shown in drawing 21 . By such tipping 
condition, the main control section 80 detects or judges having deviated from 
the usual posture based on each sensor output, such as an attitude sensor 93, 
and having resulted in the fall. 

[0146] By drawing 22 , the leg formula mobile robot 100 which judged that self 
had sideslipped shows signs that the pattern of operation for lying prone and 
shifting to a posture was started. More specifically the variation rate of the 
pitching-axis actuator A8 grade of a left shoulder joint was carried out, the left 
arm section was moved to the front-face side of the body, and the variation 
rate of a center of gravity G is tried. 



[0147] In drawing 23 , the truncus section yawing-axis actuator A7 is rotated, 
and the upper part of the body is brought close to the posture which lies prone. 
Moreover, the variation rate of the left hip joint pitching-axis actuator A17 is 
carried out to coincidence, the whole left arm section is moved to the front- 
face side of the body, and the center of gravity G is moved to the space near 
side. 

[0148] In drawing 24 , as a result of having made rotation of the truncus 
section yawing-axis actuator A7 and the left hip joint pitching-axis actuator 
A17 continuing, the left arm section is implanted and the posture which lies 
prone further is approached. 

[0149] In drawing 25 , a center of gravity G loses stability as a result of having 
made rotation of the truncus section yawing-axis actuator A7 and the left hip 
joint pitching-axis actuator A17 continuing. Consequently, the leg formula 
mobile robot's 100 whole body falls on a space near side, and the crus- 
sinistrum-diaphragmatis section is implanted. The upper part of the body lies 
prone, and considerable extent advance of the shift to a posture is carried out. 
[0150] In drawing 26 , as a result of having made rotation of the truncus 
section yawing-axis actuator A7 and the left hip joint pitching-axis actuator 
A17 continuing, the leg formula mobile robot 100 lay prone, and it has shifted 
to the posture completely. According to a pattern of operation which was 
already explained, the leg formula mobile robot 100 can rise autonomously 
(namely, he has no physical assistance from the outside), referring to drawing 
8 - drawing 13 from this posture. 

[0151] The example explained while referring to drawing 21 - drawing 26 has 
explained the pattern of operation which mainly lies prone using the drive of 
the truncus yawing-axis actuator A7, and shifts to a posture. Smoother 
posture shift is realizable what (specifically, the variation rate of the truncus 
roll axes is carried out before a truncus yawing axis) the drive of the truncus 
roll-axes actuator A6 is further used for besides this. The pattern of operation 
which uses together the truncus roll-axes actuator A6 and the truncus yawing- 
axis actuator A7, lies prone from a sideslip condition, and shifts to a posture is 
explained referring to drawing 27 and drawing 28 . 
[0152] At drawing 27 , the posture implanted only by the leg is formed by 



rotating truncus roll axes. With such a posture, the touch-down reaction force 
in the right shoulder section is mitigated, and bed leaving of the upper part of 
the body can be carried out. 

[0153] Subsequently in drawing 28 , the truncus yawing-axis actuator A7 is 
rotated. Since the variation rate of the truncus roll-axes actuator A6 is already 
carried out, the torque which the drive of the truncus yawing-axis actuator A7 
takes is mitigated. Moreover, posture change of the leg formula mobile-robot 
100 whole can also be lessened. Consequently, it can save, the energy, i.e., 
the power resource, exhausted since it lies prone from a sideslip posture and 
shifts to a posture. 

[0154] By applying two kinds of patterns of operation which were mentioned 
above, the leg formula mobile robot 100 can be prone lain from a sideslip 
condition, and a posture can be formed. According to a series of rising 
actuation patterns once it can lie prone and can form a condition, as it 
indicated to drawing 9 - drawing 13 that mentioned above as shown in 
drawing 8 , the leg formula mobile robot 100 can return to an erection 
condition autonomously (namely, he has no physical assistance). 
[0155] In addition, if an arm, a foot, etc. are in the condition that it can operate 
freely, high-speed actuation of the circumference of a truncus section yawing 
axis can be produced using the reaction force of resultant force of these 
actuation. However, if the condition that the common leg formula mobile robot 
fell is assumed, the technique of using such "momentum" is lacking in 
certainty, and since it is hard to control passing speed, we will be anxious also 
about a robot's own maintenance or the bad influence to a perimeter 
environment. If it also takes into consideration that it is in the condition which 
deviated from the normal of a fall, although it is the low speed which was 
mentioned above, it will be considered that the pattern of operation to which a 
posture is changed certainly is more desirable. 

[0156] (4) In rising drawing 29 from a supine condition - drawing 34 , the leg 
formula mobile robot 100 concerning this example is illustrating other 
examples of the actuation which rises from a supine condition. Although the 
leg formula mobile robot 100 introduced the pattern of operation which rises 
toward the direction of the front face of the body in the above-mentioned 



example explained while referring to drawing 14 - drawing 20 , here explains 
the pattern of operation which rises after once sideslipping from a posture with 
the face upward and shifting to other postures. 

[0157] The condition immediately after the leg formula mobile robot 100 falls 
to a floor line with a posture with the face upward is shown in drawing 29 . By 
such tipping condition, the main control section 80 detects or judges having 
deviated from the usual posture based on each sensor output, such as an 
attitude sensor 93, and having resulted in the fall. In this example, the pattern 
of operation which rises after further once shifting to a sideslip posture, lying 
prone further and shifting to a posture should be chosen. 
[0158] drawing 30 — both — while it has been in the condition on which a foot 
and the tooth-back section were implanted, it twists by rotating both the hip 
joint yawing-axis actuator A16 in the direction which wants to rotate the upper- 
part-of-the-body section relatively. Center-of-gravity migration in this twist 
direction is promoted by avoiding interference with the upper-part-of-the-body 
section and a floor line to coincidence, and making it rotate the pitching-axis 
actuator A8 of a left shoulder joint by rotating the pitching-axis actuator A8 of 
a right shoulder joint. 

[0159] At drawing 31 , in the condition [ having implanted the left leg section ], 
the right hip joint yawing-axis actuator A16 is rotated, and the whole right trail 
section is further rotated in this twist direction. Moreover, a center of gravity is 
moved in the predetermined direction by making coincidence rotate the left 
shoulder joint pitching-axis actuator A8 and the truncus section yawing-axis 
actuator A7. 

[0160] In drawing 32 , further, the truncus section yawing-axis actuator A7 is 
rotated, rotation of the upper-part-of-the-body section is ended mostly, and 
implantation in the right arm section is secured to coincidence. 
[0161] At drawing 33 , the right hip joint yawing-axis actuator A1 6 is mainly 
rotated, and carrying out smoothly of twist movement is attained by twisting 
the lumbar part to a predetermined hand of cut. 

[0162] Drawing 34 shows the condition that the shift to a sideslip posture was 
completed mostly. Twist movement can be promoted, and it can lie prone 
from a sideslip posture further, and can be made to shift to a posture smoothly 



by rotating further the truncus section roll-axes actuator A6. 
[0163] By supporting the pattern of operation which lies from a supine posture 
to a sideslip posture prone from a sideslip posture further, and shifts to it to a 
posture, the leg formula mobile robot 100 lies prone, only has the rising 
actuation from a condition, and becomes possible [ rising autonomously ] from 
the tipping condition of arbitration. 

[0164] In addition, **** which begins from drawing 34 and finishes it as 
drawing 29 is possible also for shifting to a condition with the face upward as 
shown in drawing 29 from the condition which sideslipped as shown in 
drawing 21 by performing the pattern of the reverse sense of operation. 
[0165] Moreover, the leg formula mobile robot 100 can also perform migration 
on a floor line, i.e., a flat surface, in the condition [ having fallen ] by repeating 
and performing shift of the posture which lies prone from a sideslip condition 
and is said to a condition from a supine condition to a sideslip condition. For 
example, even if it is a case as the obstruction has entered the upper part in 
the reverse momentum that it is (or location where head lining is low), it can 
move to the upper part to a location without an obstruction by performing 
superficial migration which starts by tipping condition. 
[0166] It has explained in detail about this invention, referring to a specific 
example more than [addenda]. However, it is obvious that this contractor can 
accomplish correction and substitution of this example in the range which 
does not deviate from the summary of this invention. 
[0167] Although the example of representation of the rising actuation at the 
time of the fall about the leg formula mobile robot 100 which performs leg 
formula migration by 2 pairs of shoes has been explained in this specification, 
the pattern of rising of operation is not limited to what was shown in the 
accompanying drawing. Please understand that a desirable rising actuation 
pattern may be changed according to the engine performance of an airframe, 
a condition, or surrounding surrounding condition, environment, etc., etc. 
[0168] In short, with the gestalt of instantiation, this invention has been 
indicated and it should not be interpreted resthctively. In order to judge the 
summary of this invention, the column of the claim indicated at the beginning 
should be taken into consideration. 



[0169] In addition, applying drawing 3 strictly should interpret flexibly 
mnemonic names, such as a joint about the leg formula mobile robot 100 of a 
2-pair-of-shoes walk when judging the summary of this invention, by contrast 
with the body mechanism of 2-pair-of-shoes erection ambulatory exercises, 
such as Homo sapiens that it is not appropriate and actual and an ape. 
[0170] A leg formula mobile robot's joint model building is illustrated to 
drawing 49 for reference. In the example shown in this drawing, the part which 
consists of an overarm, an elbow joint 6, a forearm, a wrist 7, and a hand part 
8 is called a "upper extremity" from the shoulder joint 5, Moreover, it is 
equivalent to the fuselage of the "truncus section", a call, and Homo sapiens 
in the range from the shoulder joint 5 to a hip joint 1 1 . Moreover, the range 
from the hip joint 1 1 to the truncus joint 10 is called the "lumbar part" 
especially among the truncus sections. The truncus joint 10 has the operation 
expressing the degree of freedom which the human backbone has. Moreover, 
the part which consists of the femoral region 12, the knee joint 14, the leg 
section 13, the ankle 15, and foot 16 below a hip joint 11 is called the 
"membrum inferius." Generally, it is [0171] which calls [ hip joint ] a lower part 
a "lower object" for the upper part from the "upper part of the body", a call, 
and it. In addition, the reference number used by drawing 49 should 
understand a conflicting point to be the drawing of others which were referred 
to in these specifications, such as drawing 5 . 
[0172] 

[Effect of the Invention] As a full account was given above, even if it is the 
case where it has fallen in the midst of activities, such as walk actuation, 
according to this invention, the great leg formula migration mold robot which 
can rise by himself, and its control mechanism can be offered. 
[0173] Moreover, according to this invention, it can fall, even if it is suitable 
and is various postures or the case where it lies, it can rise autonomously, 
and the great leg formula migration mold robot which can resume 
automatically the activity interrupted by fall, and its control approach 
mechanism can be offered. 

[0174] Moreover, according to this invention, it can lie prone and the great leg 
formula migration mold robot which can rise certainly and smoothly 



autonomously also from various fall postures, such as supine and sideways, 
and its control mechanism can be offered. 

[0175] By this invention, it becomes easy, the return from a fall posture, i.e., 

rising actuation, of a leg formula mobile robot. Moreover, the burdens and 

demand torque to moving part other than the truncus section at the time of 

rising actuation are mitigated. Moreover, the concentrated load to a specific 

part is avoidable by distributing and equalizing a load burden among each 

moving part. Consequently, while improving the dependability of robot 

employment, the energy efficiency in a rising actuation period improves. 

[0176] Moreover, according to the leg formula mobile robot concerning this 

invention, easier rising actuation can be alternatively performed by carrying 

out the sequential shift of two or more fall postures. 

[0177] Moreover, according to the leg formula mobile robot concerning this 

invention, superficial migration can be realized by repeating two or more fall 

postures successively, without rising. Consequently, rising actuation can be ^ 

performed after moving to the location which can start more easily. 

[0178] Moreover, according to the leg formula mobile robot concerning this 

invention, since a fall posture can be changed, the class and number of rising 

actuation patterns which must be supported can be reduced. 

[0179] For example, when the robot prepares the rising actuation pattern 

beforehand, it becomes mitigable [ compaction of a development cycle, or 

development cost ] by reduction of the number of patterns of operation. 

Moreover, since the burden of hardware is also mitigated by reduction of the 

number of patterns of operation, improvement in the part system is expected 

by it. 

[0180] Moreover, when a robot generates the pattern of operation according 
to a situation autonomously, and the number of patterns of operation which 
should be generated decreases, the burden of the arithmetic unit which 
should be carried in the robot itself is mitigated, and reduction of equipment 
manufacture cost, improvement in the dependability at the time of robot 
operation, etc. are expected. 

[0181] Moreover, according to the leg formula mobile robot concerning this 
invention, a rising actuation pattern can be limited by changing a fall posture. 



Consequently, the demand to an output torque, operating range, etc. of each 
actuator required for rising actuation is mitigated. Consequently, while the 
degree of freedom of a design improves, compaction of a development cycle, 
reduction of manufacture cost, etc. are realizable. 

[0182] Moreover, since the approach of rising by changing a fall posture can 
be limited, the power consumption of the robot in a rising actuation period can 
be saved, and the load to supply power sources, such as a dc-battery, can be 
lessened. Consequently, dc-battery drive time amount extends, continuous 
running of long duration becomes more possible by one charge, and a robot's 
working hours, workspace, a work content, etc. are expanded. Moreover, 
since the charge of use is also reduced as a required place, small and 
lightweight-ization of a dc-battery are attained, and the degree of freedom of a 
design improves. Moreover, since a dc-battery requires and a way mitigates, 
a dc-battery unit price can be held down cheaply and the manufacture cost 
and operation cost of the whole system can be saved. 



DESCRIPTION OF DRAWINGS 



[Brief Description of the Drawings] 

[Drawing 1] It is a **** Fig. about signs that the leg formula mobile robot 100 
with which operation of this invention is presented was viewed from the front. 
[Drawing 2] It is a **** Fig. about signs that the leg formula mobile robot 100 
with which operation of this invention is presented was viewed from back. 
[Drawing 3] It is drawing (front perspective view) on which the configuration of 
the leg formula mobile robot's 100 truncus section was expanded and drawn. 
[Drawing 4] It is drawing (back perspective view) on which the configuration of 
the leg formula mobile robot's 100 truncus section was expanded and drawn. 
[Drawing 5] It is drawing having shown typically the degree-of-freedom 
configuration model which the leg formula mobile robot 100 concerning this 
example possesses. 



[Drawing 6] It is drawing having shown typically the control-system 
configuration of the leg formula mobile robot 100 concerning this example. 
[Drawing 7] It is the flow chart which showed roughly the operations sequence 
at the time of the leg formula mobile robot's 100 fall. 
[Drawing 8] It is drawing having shown a series of actuation for the leg 
formula mobile robot 100 lying prone, and rising from a condition, and is 
drawing describing the condition immediately after more specifically falling to 
a floor line with the posture in which the leg formula mobile robot 100 lies 
prone. 

[Drawing 9] It is drawing describing a series of actuation for the leg formula 
mobile robot 100 lying prone, and rising from a condition, and is drawing 
describing signs that the leg formula mobile robot 100 more specifically 
started rising actuation in the fall posture which lies prone. 
[Drawing 10] It is drawing describing a series of actuation for the leg formula 
mobile robot 100 lying prone, and rising from a condition, and it is more 
specifically enlarging further each displacement of the both-shoulders joint 
pitching-axis actuator A8, truncus section pitching-axis actuator A5, and the 
hip joint pitching-axis actuator A17, and is drawing describing signs that the 
center-of-gravity location is raised further up. 

[Drawing 1 1] it is drawing describing a series of actuation for the leg formula 
mobile robot 100 lying prone, and rising from a condition, and is drawing 
describing signs that shorten further distance of an arm and the implantation 
part of each leg, consequently the center of gravity G is made to more 
specifically hold completely in the upper part of ****, i.e., a posture stable zone. 
[Drawing 12] It is drawing describing a series of actuation for the leg formula 
mobile robot 100 lying prone, and rising from a condition, and is drawing 
which more specifically described signs that the center of gravity G was 
further raised up by driving both the knee region pitching-axis actuator A19, 
and extending the leg while separating the tip of an arm from a floor line. 
[Drawing 13] It is drawing describing a series of actuation for the leg formula 
mobile robot 100 lying prone, and rising from a condition, and is drawing 
having shown signs that raised a center of gravity G up further, and the 
erection posture was more specifically approached. 



[Drawing 14] It is drawing liaving shown a series of actuation for the leg 
formula mobile robot 100 to rise from a supine condition, and is drawing which 
more specifically described the condition immediately after the leg formula 
mobile robot 100 falls to a floor line with a posture with the face upward. 
[Drawing 15] It is drawing having shown a series of actuation for the leg 
formula mobile robot 100 to rise from a supine condition, and is drawing 
where the leg formula mobile robot 100 which judged the fall posture after the 
fall more specifically described signs that the rising actuation from a supine 
posture was started. 

[Drawing 16] It is drawing describing signs that the posture which both the hip 
joint pitching-axis actuator A17, both the knee region pitching-axis actuator 
A19, and both the ankle pitching-axis actuator A20 are further operated where 
it is drawing having shown a series of actuation for the leg formula mobile 
robot 100 to rise from a supine condition and the lumbar part is more 
specifically implanted, and is implanted by the vola of both **** is prepared. 
[Drawing 17] it is drawing having shown a series of actuation for the leg 
formula mobile robot 100 to rise from a supine condition, and it is shortening 
distance of the implantation part of an arm and each leg, and, more 
specifically, is drawing describing signs that the location of a center of gravity 
G is raised up at the same time it carries out the variation rate of truncus 
pitching-axis actuator A5. 

[Drawing 18] it is drawing having shown a series of actuation for the leg 
formula mobile robot 100 to rise from a supine condition, and is drawing which 
more specifically described signs that were shortening distance of the 
implantation part of an arm and each leg, brought near ZMP by the foot as 
much as possible, and bed leaving of an arm and the lumbar part was carried 
out. 

[Drawing 19] It is drawing having shown a series of actuation for the leg 
formula mobile robot 100 to rise from a supine condition, and is drawing 
describing signs that the location of a center of gravity G is raised further, by 
more specifically forming the posture which extended. 
[Drawing 20] It is drawing having shown a series of actuation for the leg 
formula mobile robot 100 to rise from a supine condition, and is drawing which 



more specifically described signs that raised a center of gravity G up by 
extending the leg further, and the erection posture was approached. 
[Drawing 21] It is drawing having shown an example of a pattern of operation 
for the leg formula mobile robot 100 to rise from a sideslip condition, and is 
drawing describing the condition immediately after more specifically falling to 
a floor line with the posture into which the leg formula mobile robot 100 
sideslipped. 

[Drawing 22] It is drawing having shown an example of a pattern of operation 
for the leg formula mobile robot 100 to rise from a sideslip condition, and the 
leg formula mobile robot 100 which more specifically judged that it had 
sideslipped is drawing describing signs that the pattern of operation for lying 
prone and shifting to a posture was started. 

[Drawing 23] It is drawing having shown an example of a pattern of operation 
for the leg formula mobile robot 100 to rise from a sideslip condition, and is 
drawing describing signs that rotate the truncus section yawing-axis actuator 
A7, and the upper part of the body is more specifically brought close to the 
posture which lies prone. 

[Drawing 24] It is drawing having shown an example of a pattern of operation 
for the leg formula mobile robot 100 to rise from a sideslip condition, and is 
drawing describing signs that the posture which the left arm section is 
implanted and more specifically lies prone further is approached. 
[Drawing 25] It is drawing having shown an example of a pattern of operation 
for the leg formula mobile robot 100 to rise from a sideslip condition, and is 
drawing which more specifically described signs which made rotation of the 
truncus section yawing-axis actuator A7 and the left hip joint pitching-axis 
actuator A17 continue that the leg formula mobile robot's 100 whole body fell 
on a space near side as a result, and the crus-sinistrum-diaphragmatis 
section was implanted. 

[Drawing 26] It is drawing having shown an example of a pattern of operation 
for the leg formula mobile robot 100 to rise from a sideslip condition, and is 
drawing which more specifically described signs which made rotation of the 
truncus section yawing-axis actuator A7 and the left hip joint pitching-axis 
actuator A17 continue that lay prone as a result and it shifted to the posture 



completely. 

[Drawing 27] It Is drawing having shown an example of a pattern of operation 
for the leg formula mobile robot 100 to rise from a sideslip condition, and it is 
more specifically using together the drive of the truncus section yawing-axis 
actuator A7 and the truncus roll-axes actuator A6, and is drawing describing 
signs that lie prone from a sideslip condition and it shifts to a posture smoothly. 
[Drawing 28] It is drawing having shown an example of a pattern of operation 
for the leg formula mobile robot 100 to rise from a sideslip condition, and it is 
more specifically using together the drive of the truncus section yawing-axis 
actuator A7 and the truncus roll-axes actuator A6, and is drawing describing 
signs that lie prone from a sideslip condition and it shifts to a posture smoothly. 
[Drawing 29] It is drawing in which the leg formula mobile robot 100 showed 
other examples of the pattern of operation which rises from a supine condition, 
and is drawing which more specifically described the condition immediately 
after the leg formula mobile robot 100 falls to a floor line with a posture with 
the face upward. 

[Drawing 30] The leg formula migration 100 is drawing having shown other 
examples of the pattern of operation which rises from a supine condition, it is 
more specifically rotating both the hip joint yawing-axis actuator A16, and 
while twisting in the direction which wants to rotate the upper-part-of-the-body 
section relatively, it is drawing describing signs that the center of gravity is 
moved in the twist direction by rotation of the pitching axis of right-and-left 
each joint. 

[Drawing 31] It is drawing describing signs that are drawing in which the leg 
formula mobile robot 100 showed other examples of the pattern of operation 
which rises from a supine condition, and rotate the right hip joint yawing-axis 
actuator A16, and the whole right trail section is further rotated in this twist 
direction while more specifically rotating the right hip joint yawing-axis 
actuator A16 and rotating the whole right trail section in this twist direction 
further. 

[Drawing 32] It is drawing in which the leg formula mobile robot 100 showed 
other examples of the pattern of operation which rises from a supine condition, 
and. more specifically, is drawing describing signs that rotate the truncus 



section yawing-axis actuator A7, and implantation in the right arm section is 
secured, 

[Drawing 33] It is drawing in which the leg formula mobile robot 100 showed 
other examples of the pattern of operation which rises from a supine condition, 
and it is mainly rotating the right hip joint yawing-axis actuator A16, and 
twisting the lumbar part to a predetermined hand of cut, and, more specifically, 
is drawing describing signs that carrying out smoothly of twist movement is 
attained. 

[Drawing 34] It is drawing in which the leg formula mobile robot 100 showed 
other examples of the pattern of operation which rises from a supine condition, 
and is drawing where the leg formula mobile robot 100 more specifically 
described the condition that the shift to a sideslip posture was completed 
mostly. 

[Drawing 35] It is drawing having shown the appearance configuration of the 
leg formula mobile robot (conventional example) which performs the walk in 
erect posture by 2 pairs of shoes. 

[Drawing 36] It is drawing (conventional example) describing signs that the leg 
formula mobile robot which showed drawing 35 is standing straight. 
[Drawing 37] It is drawing (conventional example) describing signs that the leg 
formula mobile robot which showed drawing 35 walks, and is drawing 
describing signs that a foot on either side is more specifically changed to a 
basis and **** by turns. 

[Drawing 38] It is drawing (conventional example) having shown the condition 
of the leg formula mobile robot which showed drawing 35 having lain prone, 
and having fallen with the posture. 

[Drawing 39] It is drawing having shown the pattern of operation which rises 
from the condition of the leg formula mobile robot which showed drawing 35 
having lain prone, and having fallen with the posture, and is drawing 
(conventional example) having more specifically shown signs that a robot's 
center of gravity was raised by bringing the relative distance of the arm under 
implantation, and the leg close. 

[Drawing 40] It is drawing having shown the pattern of operation which rises 
from the condition of the leg formula mobile robot which showed drawing 35 



having lain prone, and having fallen with the posture, and is drawing 
(conventional example) having shown signs that the midst which raises a 
robot's center of gravity was made to more specifically move a foot ahead. 
[Drawing 41] It is drawing having shown the pattern of operation which rises 
from the condition of the leg formula mobile robot which showed drawing 35 
having lain prone, and having fallen with the posture, and is drawing 
(conventional example) having shown signs that moved a leg formula mobile 
robot's ZMP into a posture stable zone, and bed leaving of the arm was more 
specifically carried out. 

[Drawing 42] It is drawing having shown the pattern of operation which rises 
from the condition of the leg formula mobile robot which showed drawing 35 
having lain prone, and having fallen with the posture, and is drawing 
(conventional example) having more specifically shown signs that extended 
the leg further and rising actuation was completed after a leg formula mobile 
robot does bed leaving of the arm. 

[Drawing 43] It is drawing (conventional example) in which the leg formula 
mobile robot which showed drawing 35 showed the condition of having fallen 
with the supine posture. 

[Drawing 44] It is drawing in which the leg formula mobile robot which showed 
drawing 35 showed the pattern of operation which rises from the condition of 
having fallen with the supine posture, and it is more specifically taking the 
posture grounded to a floor line by the leg and the arm, and is drawing 
(conventional example) having shown signs that a center of gravity was raised 
up. 

[Drawing 45] It is drawing in which the leg formula mobile robot which showed 
drawing 35 showed the pattern of operation which rises from the condition of 
having fallen with the supine posture, and is drawing (conventional example) 
having shown signs that relative distance of the foot and arm on which the leg 
formula mobile robot is implanted was more specifically gradually made small. 
[Drawing 46] drawing in which the leg formula mobile robot which showed 
drawing 35 showed the pattern of operation which rises from the condition of 
having fallen with the supine posture - it is — more — concrete - a leg formula 
mobile robot's center-of-gravity location - a foot - it is drawing (conventional 



example) having shown signs that it moved to the implantation field sky. 
[Drawing 47] It is drawing in which the leg formula mobile robot which showed 
drawing 35 showed the pattern of operation which rises from the condition of 
having fallen with the supine posture, and is drawing (conventional example) 
having more specifically shown signs that extended the leg further and rising 
actuation was completed after a leg formula mobile robot does bed leaving of 
the arm. 

[Drawing 48] As a leg formula mobile robot rises from a supine posture, an 
advance of operation is drawing (conventional example) having shown signs 
that it became impossible. 

[Drawing 49] It is drawing having shown typically an example of the joint 
model building about a leg formula mobile robot. 
[Description of Notations] 

I — A head, 2 — Neck joint yawing axis 

3 - A neck joint pitching axis, 4 — Neck joint roll axes 
5 - A truncus pitching axis, 6 - Truncus roll axes 
7 - A truncus yawing axis, 8 - Shoulder-joint pitching axis 
9 - Shoulder-joint roll axes, 10 — Overarm yawing axis 

II - An elbow-joint pitching axis, 12 — Forearm yawing axis 
13 - A wrist joint pitching axis, 14 ~ Wrist joint roll axes 

15 ~ A hand part, 16 — Hip joint yawing axis 

17 -- A hip joint pitching axis, 18 -- Hip joint roll axes 

19 - A knee-joint pitching axis, 20 - Ankle joint pitching axis 

21 ~ Ankle joint roll axes, 22 - Foot (vola) 

30 - A head unit, 40 - Truncus section unit 

50 ~ An arm unit, 51 ~ Overarm unit 

52 - An elbow-joint unit, 53 — Forearm unit 

60 - A leg unit, 61 ~ Femoral region unit 

62 — A knee-joint unit, 63 — Leg part unit 

80 — A control unit, 81 — Main control section 

82 — Circumference circuit 

91 92 ~ Touch-down check sensor 



93 - Attitude sensor 

100 Leg formula mobile robot 



